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DESCRIPTION 

DESIGN METHOD FOR INDUSTRIAL PRODUCT USING CLOTHOID CURVE, 
INDUSTRIAL PRODUCTS DESIGNED BY THE DESIGN METHOD, AND METHOD 
AND DEVICE FOR NUMERICAL CONTROL USING THE CLOTHOID CURVE 

Technical Field 
[0001] 

In the follov;ing specification, a reference ''A'' is 
attached to the description concerning ^'Design method for 
industrial product using clothoid curve and industrial product 
designed by the design method" (hereinafter simply referred to 
as a design method for industrial product using a clothoid 
curve) and a reference "'B'' is attached to. the description 
concerning ^'method and device for numerical control using the 
clothoid curve" (hereinafter simply referred to as a numerical 
control method using the clothoid curve) . 
[0002] 

A. Design method for industrial products using a 
clothoid curve: 

The present invention relates to a method for designing 
the shape of an industrial product using a clothoid curve, and 
in particular, to a method for designing, in a machine including 
a mechanism in which a mechanical element having mass moves, 
smoothing the motion of the mechanical element. 
[0003] 

B. Numerical control method using the clothoid curve: 
The present invention relates to a numerical control 

method and device for controlling motion of a tool (including 
grippers such as hands and others and various tools) of working 



i 
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machines (hereinafter referred to as robots etc.), such as 
robots, machine tools, assembly machines, and inspection 
machines, using a clothoid curve, and in particular, to a 
numerical control method and device for controlling a 
three-dimensional motion of the tool. 

Background Art 
[0004] 

A. Design method for industrial products using a 
clothoid curve: 

In response to making machines into a compact form and 
at high precision, it has become significant to have a mechanism 
in which a mechanical element which has able to move at high 
speed. The demand for realizing fast and high-precision motion, 
with less vibration and error in motion and with aging and damage 
suppressed, through a design for smooth motion trajectories 
with no dynamically unreasonable force, has been required 
strongly. 
[0005] 

As to methods for designing free motion trajectories, a 
technique to connect analytic curves, such as straight lines 
and circular arcs, and a spline curve interpolation (i.e., a 
technique to interpolate a row of points to be given with spline 
curves) have conventionally been used (refer to a non-patent 
reference 1 ) . 
[0006] 

B. Numerical control method using the clothoid curve: 
In the case of robots performing numerical control in 

welding, painting, application of adhesives, and others, it is 



general that input figures are inputted as discrete data 
consisting of rows of points. To produce continuous figures^ 
it is therefore necessary to interpolate the rows of points 
using some techniques. 
[0007] 

As methods for performing interpolation between 
arbitrarily given point rows, there have been known a technique 
to round angles of broken lines, a B-spline interpolation, a 
cubic spline interpolation, and others. As an interpolation 
in which respective given points can be traced by strictly 
passing those points, the cubic spline interpolation has been 
known (refer to the non-patent reference 1). 
[0008] 

However, since the cubic spline interpolation is 
expressed with a parameter that uses independent variable with 
no geometrical meaning, the cubic spline interpolation has a 
large fault that the relationship between the independent 
variable and geometric quantities of curves is indefinite. 
This cubic spline interpolation has a complicated relationship 
between distances moved from a starting point and the curvature, 
and is therefore inadequate to control that requires a linear 
velocity be held at a constant value. 
[0009] 

Non patent reference 1: Mamoru HOSAKA, Toshio SADA, 
''Integrate-type CAD/CAM system", Ohmsya, 1999; 

Non patent reference 2: Shi-yu QIU, Hiroshi MAKING, 
Hiroharu SUDA, Yasuo YOKOYAMA ''Free Curve Interpolation Using 
Clothoidal Curve" (The Robotics Society Of Japan, vol8. No. 6, 
pp40-47) ; and 
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Non patent reference 3 by Li Guiquing, Li Xianmin, and 
Li Hua, ^^3D Discrete Clothoid Splines," (CGI' 01, pp321-324). 

Disclosure of the Invention 
[0010] 

A. Design method for industrial products using a 
clothoid curve: 

In techniques to connect analytic curves, such as 
straight lines and circular arcs, it is difficult to 
continuously connect curvatures at points connecting a straight 
line and a circular arc. When a technique to perform the 
interpolation with spline curves is adopted, the curvatures can 
be connected continuously, but it is difficult to design a 
distribution of covertures with no dynamically unreasonable 
force along a trajectory, because of the complicated 
relationship between distances moved from a starting point and 
curvatures. Thus favorable motion trajectories cannot be 
obtained . 
[0011] 

Accordingly, the present invention has an object to 
provide a technique for designing, in a machine incorporating 
a mechanism in which a mechanical element having a mass moves, 
a motion trajectory allowing the mechanical element to move 
smoothly. The present technique is novel and innovative and 
has been created by the present inventors. 
[0012] 

Herein, the ^^smooth" is that changes of tangent lines, 
a osculating plane (a normal line) , curvatures and other factors 
on a trajectory are continuous along the trajectory, and means 
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that a force exerted on a mechanical element moving along a 

trajectory changes continuously. 

[0013] 

By the way, ball screws frequently used in robots, machine 
tools, assembly machines, inspection machines and others have 
a regression path of which mode is composed of connections of 
straight lines and circular arcs. Thus tangent lines and 
curvatures of a curve are not continuous and trajectory design 
is short of flexibility as well. 
[0014] 

Another object of the present invention is to establish, 
in designing a circulation path of a ball of a ball screw, a 
circulation path which lessens loss of motion energy of the ball 
circulating along the path and which provides not only 
continuous tangent lines and curvatures on the circulation path 
but alto moderate changes in the curvatures in order that parts 
providing the circulation path are avoided from being damaged. 
A design method for the circulation path of the ball screw is 
an application of the above method for designing a motion 
trajectory that allows a mechanical element to move smoothly. 
[0015] 

B. Numerical control method using the clothoid curve: 
A clothoid interpolation has been proposed by the 
inventors, which serves as an interpolation passing each point 
to be given two-dimensionally, and it has been known that this 
clothoid interpolation provides a smooth interpolation (refer 
to a non-patent reference 2) . Hence, if a clothoid curve used 
by this interpolation is extended to a thee-dimensional one so 
that it is used for interpolation of a row of free points, it 
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is supposed that, thanks to features of the clothoid curve 
expressed as a function of lengths of curves, control that 
allows a linear speed to be constant or to be changed depending 
on line lengths can be realized easily. In addition, because 
the curve lengths are assigned to a parameter, there is an 
advantage that it is unnecessary to post-calculate line lengths, 
unlike the other methods. It is thus expected that extending 
the clothoid interpolation to the three-dimensional one is 
effective in various fields including numeral control- As 
techniques created by extending the clothoid curve to the 
three-dimensional ones, some references including ^'3D Discrete 
Clothoid Splines'' by Li et al. (refer to a non-patent reference 
3) have been known. However, techniques created by 
three-dimensionally extending the clothoid curve and expressed 
in the formulated form have not been know yet. The extension 
in the formulated form is advantageous in easier calculation 
of each value. 
[0016] 

Accordingly, for numerically controlling the motion of 
a machine tool, the present invention has an object to provide 
the definition expression of a novel three-dimensional clothoid 
curve which utilizes, as much as possible, the characteristics 
of a two-dimensional clothoid curve wherein changes in the 
curvatures vs. an independent variable show a simple pattern. 
In addition, the present invention has a further object to 
interpolate a row of points by using this three-dimensional 
clothoid curve - 
[0017] 

A. Design method for industrial products using a 



clothoid curve: 

Hereinafter, the invention according to a method for 
designing industrial products using the clothoid curve 
described in claims 1-10 will now be described. 
[0018] 

The invention in claim 1 solves the foregoing problems 
by employing the method for designing industrial products, 
wherein the design method is characterized in that the shape 
of an industrial product is designed by using a 
three-dimensional curve (referred to as a three-dimensional 
clothoid curve) in which each of a pitch angle and a yaw angle 
in a tangential direction is given by a quadratic expression 
of a curve length or a curve length variable. 
[0019] 

The invention in claim 2 is characterized in that, in the 
design method for industrial products described in claim 1, the 
industrial product is a machine including a mechanism in which 
a mechanical element having a mass moves and a trajectory of 
motion of the mechanical element is designed by using the 
three-dimensional curve (referred to as the three-dimensional 
clothoid curve) - 
[0020] 

The invention in claim 3 is characterized in that, in the 
design method for industrial products described in claim 2, the 
machine is a screw device including a mechanism in which a ball 
as the mechanical element moves, the screw device comprises a 
screw shaft having an outer surface on which a spiral rolling 
element rolling groove is formed, a nut having an inner surface 
on which a load rolling element rolling groove is formed so as 
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to be opposed to the rolling element rolling groove and a 
regression path is formed to connect a one end and the other 
end of the load rolling element rolling groove, and a plurality 
of rolling elements disposed between the rolling element 
rolling groove of the screw shaft and the load rolling element 
rolling groove of the nut and disposed in the regression path, 
and the regression path of the screw device is designed by using 
the three-dimensional curve (reefed to as the three-dimensional 
clothoid curve) - 
[0021] 

The invention in claim 4 is characterized in that, in the 
design method for industrial products described in any one of 
claims 1 to 3, the three-dimensional clothoid curve is defined 
by the following expressions. 
[Numeral 1] 
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wherein 
[Numeral 2] 
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shows a positional vector at each point on the three-dimensional 
clothoid curve and its initial value, respectively. 

Assume that the length of a curve from a starting point 
is s and its whole length (a length from the starting point to 
an end point) is h. A value produced by dividing s by h is 
expressed as S. S is a dimensionless value, which is called 
a curve length variable. 

i, j and k are unit vectors in the x-axis, y~axis and z-axis 
directions , respectively . 

u is a unit vector showing a tangential direction of a 
curve at a point P, which is given by Expression (2) . e'^^ and 
E^** are rotation matrices and represent an angular rotation of 
angle P about the k-axis and an angular rotation of angle a about 
the j-axis, respectively. The former is referred to as a yaw 
rotation, while the latter is referred to as a pitch rotation. 
Expression (2) means that the unit vector in the i-axis 
direction is rotated by an angle a about the j-axis, before 
being rotated by an angle p about the k-axis, thus producing 
a tangent vector u. ao/ ai, 32/ bo/ bi and b2 are constants. 
[0022] 

The invention in claim 5 is characterized in that, in the 
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design method for industrial products described in claim 4, a 
plurality of spatial points are specified in a 
three-dimensional coordinate and these spatial points are 
interpolated by using the three-dimensional clothoid curve, 
whereby the shape of the industrial product is designed. 
[0023] 

The invention in claim 6 is characterized in that, in the 
design method for industrial products described in claim 5, 
seven parameters ao, ai, a2/ bo, bi, b2 and h of the 
three-dimensional clothoid segments are calculated so that, 
between a one three-dimensional clothoid segment (a unit curve 
consisting of a group of curves produced on the interpolation) 
and the next three-dimensional clothoid segment (a unit curve 
consisting of a group of curves produced on the interpolation) , 
positions, tangential directions, normal directions, and 
curvatures of both the one and next three-dimensional clothoid 
segments are made continuous to each other, respectively, at 
the plurality of spatial points. 
[0024] 

The invention in claim 7 is characterized in that, in the 
design method for industrial products described in claim 6, the 
seven parameters ao, ai, az, bo/ bi, b2 and h of the 
three-dimensional clothoid segments are calculated by making 
the number of conditional expressions produced by mutual 
addition to be made between conditional expressions concerning 
the tangential directions, the normal directions and the 
curvatures at both the starting point and the end point and 
further conditional expressions allowing the positions, the 
tangential directions, the normal directions, and the 
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curvatures of both the one and next three-dimensional clothoid 
segments to be made continuous to each other, respectively, at 
the plurality of spatial points agree with the unknowns of the 
seven parameters ao^ ai, a2f bo, bi, b2 and h of the 
three-dimensional clothoid segments, whereby the conditional 
expressions is made agree with the unknowns in terms of number 
thereof, by specifying the tangential directions, the normal 
directions and the curvatures at the stating point and the and 
point among the plurality of spatial points and additionally 
inserting objective points being interpolated between the 
spatial points which have been specified in advance. 
[0025] 

The invention in claim 8 is an industrial product designed 
by using the design method for industrial products according 
to any one of claims 1 to 7 . 
[0026] 

The invention in claim 9, which is for designing the shape 
of an industrial product, is a program enabling a computer to 
operate as means to design the shape of the industrial product 
by using a three-dimensional curve (referred to as a 
three-dimensional clothoid curve) in which each of a pitch angle 
and a yaw angle in a tangential direction is given by a quadratic 
expression of a curve length or a curve length variable. 
[0027] 

The invention in claim 10, which is for designing the shape 
of an industrial product, is a computer-readable recording 
medium recording thereon a program enabling a computer to 

operate as means to design the shape of the industrial product 
by using a three-dimensional curve (referred to as a 
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three-dimensional clothoid curve) in which each of a pitch angle 
and a yaw angle in a tangential direction is given by a quadratic 
expression of a curve length or a curve length variable. 



Hereinafter, the invention of a numerical control method 
using the clothoid curve, which is described in claims 11 to 
27, will now be described. 



The invention in claim 11 solves the foregoing problems 
by employing a numerical control method expressing a trajectory 
of a machine tool or the contour shape of a workpiece by using 
a three-dimensional curve (referred to as a three-dimensional 
clothoid curve) in which each of a pitch angle and a yaw angle 
in a tangential direction is given by a quadratic expression 
of a curve length or a curve length variable and controlling 
motion of the machine tool based on the three-dimensional curve. 
[0030] 

The invention in claim 12 is provided such that, in the 
numerical control method described in claim 11, the 
three-dimensional clothoid is defined by the following 
expressions . 
[Numeral 3] 
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B. Numerical control method using the clothoid curve: 
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shows a positional vector at each point on the three-dimensional 
clothoid curve and its initial value, respectively. 

Assume that the length of a curve from a starting point 
is s and its whole length (a length from the starting point to 
an end point) is h. A value produced by dividing s by h is 
expressed as S. S is a dimensionless value, which is called 
a curve length variable, 

i, j and k are unit vectors in the x~axis, y-axis and z~axis 
directions, respectively . 

u is a unit vector showing a tangential direction of a 



curve at a point P, which is given by Expression (2) 



and 



E^°^ are rotation matrices and represent an angular rotation of 
angle p about the k-axis and an angular rotation of angle a about 
the j-axis, respectively. The former is referred to as a yaw 
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rotation, while the latter is referred to as a pitch rotation. 
Expression (2) means that the unit vector in the i-axis 
direction is rotated by an angle a about the j-axis, before 
being rotated by an angle (3 about the k-axis, thus producing 
a tangent vector u. In this Expression, ao/ ai, a2, bo, bi and 
b2 are constants. 
[0031] 

The invention in claim 13 is a numerical control device 
expressing a trajectory of a machine tool or the contour shape 
of a workpiece by using a three-dimensional curve (referred to 
as a three-dimensional clothoid curve) in which each of a pitch 
angle and a yaw angle in a tangential direction is given by a 
quadratic expression of a curve length or a curve length 
variable and controlling motion of the machine tool based on 
the three-dimensional curve. 
[0032] 

The invention in claim 14, which is for numerically 
controlling motion of a machine tool, is a program enabling a 
computer to operate as means to express a trajectory of the 
machine tool or the contour shape of a workpiece by using a 
three-dimensional curve (referred to as a three-dimensional 
clothoid curve) in which each of a pitch angle and a yaw angle 
in a tangential direction is given by a quadratic expression 
of a curve length or a curve length variable . 
[0033] 

The invention in claim 15, which is for numerically 
controlling motion of a machine tool, is a computer-readable 
recording medium recording thereon either a program enabling 
a computer to operate as means to express a trajectory of the 
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machine tool or the contour shape of a workpiece by using a 
three-dimensional curve (referred to as a three-dimensional 
clothoid curve) in which each of a pitch angle and a yaw angle 
in a tangential direction is given by a quadratic expression 
of a curve length or a curve length variable^ qr results computed 
based on the program. 
[0034] 

The invention in claim 16 resolve the foregoing problems 
by employing a numerical control method comprising steps of 
interpolating points of a row of points arbitrarily given in 
a three-dimensional coordinate by using a three-dimensional 
curve (referred to as three-dimensional clothoid segments) in 
which each of a pitch angle and a yaw angle in a tangential 
direction is given by a quadratic expression of a curve length 
or a curve length variable and controlling motion of a machine 
tool based on the three-dimensional clothoid segments. 
[0035] 

The invention in claim 17 is a numerical control method 
comprising a step of mutually connecting a plurality of 
three-dimensional clothoid curves (each of which is referred 
to as three-dimensional clothoid segments) in each of which each 
of a pitch angle and a yaw angle in a tangential direction is 
given by a quadratic expression of a curve length or a curve 
length variable and a step of controlling motion of a machine 
tool based on the plural three-dimensional clothoid segments. 
[0036] 

The invention in claim 18 is provided such that, in the 
numerical control method described in claim 16 or 17, the 
three-dimensional clothoid curve is defined by the following 
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expressions . 
[Numeral 5] 
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shows a positional vector at each point on the three-dimensional 
clothoid curve and its initial value, respectively. 

Assume that the length of a curve from a starting point 
is s and its whole length (a length from the starting point to 
an end point) is h. A value produced by dividing s by h is 
expressed as S. S is a dimensionless value, which is called 
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a curve length variable. 

i, j and k are unit vectors in the x-axis, y-axis and z-axis 
directions, respect ively - 

u is a unit vector showing a tangential direction of a 
curve at a point P, which is given by Expression (2) . EkP and 
Eja are rotation matrices and represent an angular rotation 
of angle p about the k-axis and an angular rotation of angle 
a about the j-axis, respectively. The former is referred to 
as a yaw rotation, while the latter is referred to as a pitch 
rotation. Expression (2) means that the unit vector in the 
i-axis direction is rotated by an angle a about the j-axis, 
before being rotated by an angle p about the k-axis, thus 
producing a tangent vector u, ao, ai, a2f bo, bi and are 
constants , 
[0037] 

The invention in claim 19 is characterized in that, in 
the numerical control method according to claim 18, the seven 
parameters a^ ai, az, ho, bi, b2 and h are calculated in such 
a manner that, at a connecting point between, of the plural 
three-dimensional clothoid segments, a single 

three-dimensional clothoid segment and the next 
three-dimensional clothoid segment thereto, positions and 
tangential directions (and in some cases, curvatures) of both 
three-dimensional clothoid segments are continuous, 
respectively. The positions and the tangential directions 
should always be continuous, respectively, and the curvatures 
are required to be continuous according to need. 
[0038] 

The invention is claim 20 is a numerical control device 
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interpolating points of a row of points arbitrarily given in 
a three-dimensional coordinate by using a three-dimensional 
curve in which each of a pitch angle and a yaw angle in a 
tangential direction is given by a quadratic expression of a 
curve length or a curve length variable and controlling motion 
of a machine tool based on the three-dimensional clothoid 
segments . 
[0039] 

The invention in claim 21 is a program, which is for 
numerically controlling motion of a machine tool, enabling a 
computer to operate as means to interpolate points of a row of 
points arbitrarily given in a three-dimensional coordinate by 
using a three-dimensional curve in which each of a pitch angle 
and a yaw angle in a tangential direction is given by a quadratic 
expression of a curve length or a curve length variable and 
controlling the motion of the machine tool based on the 
three-dimensional clothoid segments . 
[0040] 

The invention in claim 22 is a computer-readable 
recording medium, which is for numerically controlling motion 
of a machine tool, recording either a program enabling a 
computer as means for interpolating points of a row of points 
arbitrarily given in a three-dimensional coordinate by using 
a three-dimensional curve in which each of a pitch angle and 
a yaw angle in a tangential direction is given by a quadratic 
expression of a curve length or a curve length variable, or 
results calculated on the program. 
[0041] 

The invention in claim 23 is a numerical control method 
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comprising steps of expressing a trajectory of a machine tool 
or a contour shape of a workpiece by using a three-dimensional 
curve (referred to as a three-dimensional clothoid curve) in 
which each of a pitch angle and a yaw angle in a tangential 
direction is given by a quadratic expression of a curve length 
or a curve length variable, specifying motion of the machine 
tool to be moved along the three-dimensional curve, and 
calculating a moved position of the machine tool at unit-time 
intervals according to the specified motion, wherein the motion 
is defined as positional information changing as a function of 
time . 
[0042] 

The invention in claim 24 is provided such that, in the 
numerical control method according to claim 23, the 
three-dimensional clothoid curve is defined by the following 
expressions . 
[Numeral 7] 
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P = bQ+b^S + b^S^ (4) 



wherein, 
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shows a positional vector at each point on the three-dimensional 
clothoid curve and its initial value, respectively. 

Assume that the length of a curve from a starting point 
is s and its whole length (a length from the starting point to 
an end point) is h. A value produced by dividing s by h is 
expressed as S. S is a dimensionless value, which is called 
a curve length variable. 

i, j and k are unit vectors in the x-axis, y-axis and z-axis 
directions , respectively . 

u is a unit vector showing a tangential direction of a 
curve at a point P, which is given by Expression (2) . Ekp and 
Eja are rotation matrices and represent an angular rotation 
of angle p about the k-axis and an angular rotation of angle 
a about the j-axis, respectively. The former is referred to 
as a yaw rotation, while the latter is referred to as a pitch 
rotation. Expression (2) means that the unit vector in the 
i-axis direction is rotated by an angle a about the j-axis, 
before being rotated by an angle p about the k-axis, thus 
producing a tangent vector u. ao, ai, a2, bo/ bi and b2 are 
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constants . 
[0043] 

The invention in claim 25 is a numerical control device 
which is configured to express a trajectory of a machine tool 
or a contour shape of a workpiece by using a three-dimensional 
curve (referred to as a three-dimensional clothoid curve) in 
which each of a pitch angle and a yaw angle in a tangential 
direction is given by a quadratic expression of a curve length 
or a curve length variable, specify motion of the machine tool 
to be moved along the three-dimensional curve, and calculate 
a moved position of the machine tool at unit-time intervals 
according to the specified motion, wherein the motion is defined 
as positional information changing as a function of time. 
[0044] 

The invention in claim 26 is a program, which is for 
numerically controlling motion of a machine tool, enabling a 
computer to operate as means for expressing a trajectory of a 
machine tool or a contour shape of a workpiece by using a 
three-dimensional curve (referred to as a three-dimensional 
clothoid curve) in which each of a pitch angle and a yaw angle 
in a tangential direction is given by a quadratic expression 
of a curve length or a curve length variable, means for 
specifying motion of the machine tool to be moved along the 
three-dimensional curve, and means for calculating a moved 
position of the machine tool at unit-time intervals according 
to the specified motion, wherein the motion is defined as 
positional information changing as a function of time. 
[0045] 

The invention in claim 27 is a computer-readable 
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recording medium, which is for numerically controlling motion 
of a machine tool, recording thereon a program enabling a 
computer to operate as means for expressing a trajectory of a 
machine tool or a contour shape of a workpiece by using a 
three-dimensional curve (referred to as a three-dimensional 
clothoid curve) in which each of a pitch angle and a yaw angle 
in a tangential direction is given by a quadratic expression 
of a curve length or a curve length variable, means for 
specifying motion of the machine tool to be moved along the 
three-dimensional curve, and means for calculating a moved 
position of the machine tool at unit-time intervals according 
to the specified motion, wherein the motion is defined as 
positional information changing as a function of time. 
[0046] 

A. Design method for industrial products by using the 
clothoid curve: 

In the inventions according to claims 1-10, by using the 
three-dimensional clothoid curve, the motion of a mechanical 
element can be designed so that a trajectory of the motion 
becomes smooth. Designing the trajectory in this way makes it 
possible that machines move in a dynamically unforced condition, 
cause no deterioration in their functions due to motion errors, 
and have less damage in their trajectories. 
[0047] 

In particular, as to a screw device, it is possible to 
provide a general method of producing a spatial curve which is 
necessary for designing circulating paths of the rolling 
elements in the screw device. It is possible to design the 
circulating paths so that changes in a restraining force exerted 
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on a rolling element are smooth when the rolling element moves 
with acceleration and deceleration along a spatial curve on a 
circulating path. This feature allows the rolling element to 
move in a soft and smooth manner, thereby the efficiency of power 
transmission in the screw device is improved and friction force 
and inertia force are avoided from being generated excessively. 
Accordingly, with parts avoided from being damaged, screw 
devices with high reliability can be provided. 
[0048] 

In addition, by utilizing the feature that a pattern of 
changes in curvature can be controlled, a large number of 
applications in various industrial fields can be provided. For 
example, in designing the shapes of objects to be designed in 
an aesthetic fashion, this versatile curve design method can 
be applied effectively to the design. 
[0049] 

B. Numerical control method using the clothoid curve: 
In the inventions according to claims 11 to 27, a curve 
has a principal variable which is a curve length or a curve length 
variable and a pitch angle and a yaw angle in the tangential 
direction on the curve are provided quadratic expressions of 
the curve length or the curve length variable, respectively. 
Accordingly, differential coefficient of first order of the 
quadratic expression provides a normal direction and 
differential coefficient of second order of the quadratic 
expression provides a curvature. It is thus assured that the 
normal line and curvature are continuous in respect of the curve 
length or the curve length variable. In other words, the normal 
direction and curvature are continuous along one clothoid curve. 
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It is therefore possible to provide smooth curves with 
high-quality characteristics, thus providing the numeral 
control technique that suppresses changes in velocity within 
a mechanically unforced range. 

Brief Description of the Drawings 
[0050] 

Fig. 1 is a graph showing a two-dimensional clothoid curve 
±n an xy coordinate system; 

Fig. 2 is a view showing the shape of a typical 
two-dimensional clothoid curve; 

Fig. 3 is a viev; explaining the definition of a pitch angle 
a and a yaw angle P of a three-dimensional clothoid curve; 

Fig. 4 is a view showing the shape of a typical 
three-dimensional clothoid curve; 

Fig. 5 is a view showing an amount of changes in a unit 
normal vector; 

Fig. 6 is a view showing two three-dimensional clothoid 
curves which are identical in their sizes and shapes to each 
other but are opposite in their directions to each other; 

Fig. 7 is an illustration explaining dividing a 
three-dimensional clothoid curve; 

Fig. 8 is an illustration explaining conditions for 
G^- continuous interpolation; 

Fig. 9 conceptually shows osculating planes; 
Fig. 10 is a flowchart outlining the procedures necessary 
for clothoid interpolation; 

Fit. 11 is a flowchart outlining the procedures for the 
clothoid interpolation satisfying conditions of the 
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continuity; 

Fig. 12 is a view showing three-dimensional clothoid 
interpolation for points Pi, P2 and P3; 

Fig. 13 is a view showing 3D Discrete Clothoid Splines 
of r=4; 

Fig. 14 is an illustration for the 3D Discrete Clothoid 
Splines; 

Fig. 15 is a perspective view of a three-dimensional 
Clothoid curve produced with the interpolation; 

Fig. 16 is a graph showing changes in curvature, in which 
an axis of abscissas represents a moved distance and an axis 
of ordinate represents the curvature; 

Fig. 17 is a flowchart outlining the three-dimensional 
clothoid interpolation that controls values at both end points; 

Fig. 18 is an outlined view explaining the 
three-dimensional clothoid interpolation that controls values 
at both end points; 

Fig. 19 is a perspective view showing results 
interpolated actually; 

Fig. 20 is a graph showing the relationship between a 
distance moved from a starting point of each curve and a 
curvature of each curve; 

Fig. 21 is a view showing control of values at a middle 

point ; 

Fig. 22 is a flowchart outlining an interpolation method 
that uses three-dimensional clothoids controlling each value 
at a starting point and an end point; 

Fig. 23 is a view showing 3D Discrete Clothoid Splines 
of r=4; 
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Fig. 24 is a view showing a produced polygon; 

Fig. 25 is a view explaining the three-dimensional 

clothoid curve for respective points Pi, P2 and P3; 

Fig. 26 is a view showing both produced curves and polygons- 
Fig . 27 is a view showing a curve into which points are 

inserted; 

Fig. 28 is a view showing divided three-dimensional 
clothoid curves; 

Fig. 29 is a perspective view showing a produced curve; 

Fig. 30 is a graph showing the relationship between a 
distance s moved from a starting point of each curve and a 
curvature k of each curve; 

Fig. 31 is a perspective view showing a deflector type 
of ball screw in which a deflector is produced separately from 
a nut; 

Fig. 32 is a perspective view showing a nut to be combined 
with a ball screw of which deflector composes one device with 
the nut; 

Fig. 33A is a perspective view illustrating the nut in 
a state where a ball circulating groove can be seen; 

Fig. 33B is a perspective view illustrating the nut in 
a state where a load ball rolling groove can be seen; 

Fig. 34 is a side view showing a state where the nut is 
combined with a screw shaft; 

Fig. 35 is a development elevation showing the 
circulating path of a conventional ball screw; 

Fig. 36 is a graph showing curvatures of the circulating 
path of a conventional ball screw; 

Fig. 37 is a view showing a trajectory depicted the center 
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of a ball; 

Fig. 38 shows a coordinate system; 

Fig. 39 shows a coordinate system viewed downward along 
a 2-axis; 

Fig. 40 is a view showing a trajectory curve depicted by 
the center of a ball moving along a thread groove; 

Fig. 41 is a view showing curves Co and Ci viewed downward 
along a y-axis; 

Fig. 42 is a view showing the curves Co and Ci located 
in the vicinity of a point Ps, which is viewed downward along 
the z-axis; 

Fig. 43 is a view showing a curve into which a point P2 
is inserted; 

Fig. 4 4 is a view showing the curve Cq and a produced 
regression path; 

Fig. 45 is a graph showing the relationship between a 
distance moved from a point Pg and a curvature; 

Fig. 4 6 is a view for explaining a two-dimensional 
clothoid curve in the xy coordinate system; 

Fig. 47 is a two-dimensional clothoid curve; 

Fig. 48 is a view for explaining a and P of a 
three-dimensional clothoid curve; 

Fig. 4 9 is a view showing a typical three-dimensional 
clothoid curve; 

Fig. 50 is an illustration explaining conditions for 
G^-continuous interpolation; 

Fig. 51 conceptually shows contacted surfaces; 

Fig. 52 is a flowchart outlining the procedures necessary 
for clothoid interpolation; 
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Fit. 53 is a flowchart outlining the procedures for the 
clothoid interpolation satisfying conditions of the G 
continuity; 

Fig. 54 is a view showing three-dimensional clothoid 
interpolation for points Pi, Pa and P3; 

Fig. 55 is a view showing 3D Discrete Clothoid Splines 
of r=4; 

Fig. 56 is an illustration for the 3D Discrete Clothoid 
Splines; 

Fig. 57 is a perspective view of a three-dimensional 
clothoid curve produced with the interpolation; 

Fig. 58 is a graph showing changes in curvature, in which 
an axis of abscissas represents a moved distance and an axis 
of ordinate represents the curvature; 

Fig. 59 is a flowchart outlining the three-dimensional 
clothoid interpolation that controls values at both end points; 

Fig. 60 is an outlined view explaining the 
three-dimensional clothoid interpolation that controls values 
at both end points; 

Fig. 61 is a perspective view showing results 
interpolated actually; 

Fig. 62 is a graph showing the relationship between a 
distance moved from a starting point of each curve and a 
curvature of each curve; 

Fig. 63 is a view showing control of values at a middle 

point; 

Fig. 64 is a flowchart outlining an interpolation method 
that uses three-dimensional clothoids controlling each value 
at a starting point and an end point; 



29 

Fig. 65 is a view showing 3D Discrete Clothoid Splines 
of r=4; 

Fig. 66 is a view showing a produced polygons- 
Fig. 67 is a view explaining the three-dimensional 
clothoid curve for respective points Pi, P2 and P3; 

Fig . 68 is a view showing both produced curves and polygons- 
Fig. 69 is a view showing a curve into which points are 
inserted; 

Fig. 70 is a view showing divided three-dimensional 
clothoid curves; 

Fig. 71 is a perspective view showing a produced curve; 

Fig. 72 is a graph showing the relationship between a 
distance s moved from a starting point of each curve and a 

curvature k of each curve; 

Fig, 73 is a flowchart explaining how to perform a 
numerical control method; and 

Fig. 74 is a graph showing a conventional spline curve, 
which is introduced for the comparison. 

Best Mode for Carrying Out the Invention 
[0051] 

A. Design method for industrial products using a 
clothoid curve: 

Hereinafter, an embodiment of a method for designing 
industrial products using a clothoid curve, which is according 
to the present invention, will now be described in turn based 
on listed items which are 1: definition and features of a 
three-dimensional clothoid curve, 2: an interpolation method 
using the three-dimensional clothoid curve, 3: a method for 
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designing, with the use of a three-dimensional clothoid 
interpolation, the regression path of a ball screw serving as 
a screw device, and 4: a numerical control method using the 
three-dimensional clothoid interpolation . 
[0052] 

1. Definition and characteristics of a 

three-dimensional clothoid curve: 
[0053] 

(1-1) Basic expression of the three-dimensional 
clothoid: 

A clothoid curve (Clothoid curve) , which is also called 
Cornu' s spiral, is a curve whose curvature changes in proportion 
to the length of the curve - 
[0054] 

A two-dimensional clothoid curve already proposed by the 
inventors is one kind of planer curves (two-dimensional curve) 
and is expressed by the following expressions defined in the 
xy coordinate shown in Fig. 1. 
[0055] 
[Numeral 9] 

P = Po+ JJej^ds = Po +hJ^^ej^dS, 0<s<h, 0<S = |-<1 

(1-1) 

^ = Co +CiS + C2S =^o+^vS + ^uS (1-2) 
wherein 
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[Numeral 10] 

P = X + jy, j-V^ (1«3) 

is a positional vector representing a point on the curve and 
[Numeral 11] 

Pq = X 0 + jy 0 (1-4) 

is an initial value (a positional vector at a starting point) 
of the positional vector. 
[Numeral 12] 

= cos (f> + jsin ^ (i-5) 

is a unit vector (a vector of which length is 1) representing 
a tangential direction on the curve and the direction (j) is 
measured in the counterclockwise direction from an original 
line (x-axis direction) , Multiplying this unit vector by an 
infinitesimal length ds and integrating the multiplied results 
leads to acquisition of a point P on the curve. 
[0056] 

Let us assume that a length on the curve, which is measured 
along the curve from a starting point thereof, is s and a whole 
length (a length from the starting point to an end point of the 
curve) is h. A value obtained by dividing s by h is expressed 
as S. S is a dimensionless value, which is referred to as a 
curve length variable. 
[0057] 

As shown in Expression (1-2) , the clothoid curve has a 

feature that the tangential direction angle ^ is expressed as 
a quadratic expression of the curve length s or the curve length 
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variable S. co, Ci, and 02 or (j)©/ and are coefficients of 
the quadratic expression, and these coefficients and the whole 
length h of the curve are called clothoid parameters. Fig. 2 
shows the shape of a general clothoid curve. 
[0058] 

The above relationships are expanded to the 
three-dimensional one to produce expressions presenting a 
three-dimensional clothoid curve. Conventionally, 
expressions which provide the three-dimensional clothoid curve 
have not been known. This time, however, the present inventors 
have completed this expansion for the first time in this field. 
[0059] 

The three-dimensional clothoid curve is defined by the 
following expressions . 
[0060] 

[Numeral 13] 



p = p. + f'uds = Pq + h f^udS , 0 < s < h, 0 < S = < 1 
^ Jo ''JO h 

(1-6) 
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(1-7) 

a = ao-i-a|S + a2S (I-8) 
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y^ = bo+b,S+b2S^ (1-9), 



wherein 
[Numeral 14] 





X 






p = < 


y 




yo * 




z 







(1-10) 



denotes a positional vector at each point on the 
three-dimensional clothoid and an initial value of the 
positional vector, respectively. i, j and k are unit vectors 
in the x-axis, y-axis and z-axis directions, respectively. 
[0061] 

u is a unit vector representing the tangential direction 
at the point P on the curve, which is given by Expression (1-7) . 
In Expression (1-7) , E^*^ and E^** show rotation matrices and, as 
shown in Fig. 3, mean a rotation of angle p about the k-axis 
(2-axis) and a rotation of angle a about the j-axis (y-axis), 
respectively. The former is called a yaw rotation, while the 
latter is called a pitch rotation. Expression (1-7) thus means 
that rotating the unit vector in the i-axis (x-axis) direction 
by an angle a about the j-axis (y-axis) and then rotating the 
resultant unit vector by an angle P about the k-axis (z-axis) 
produces the tangential vector u. 
[0062] 

In other words, in the case of the two-dimension, a unit 
vector e^*^ representing a tangential direction on a curve is 
obtained on a tilt angle (|) made from the x-axis. In the case 
of the three-dimension, the tangential vector u on a curve can 
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be obtained on the pitch angle a and the yaw angle p. A pitch 
angle of 0 provides a two-dimensional clothoid curve wound in 
the xy plane, while a yaw angle of 0 provides a two-dimensional 
clothoid curve wound in the xz plane- Multiplying the 
tangential vector u by an infinitesimal length ds and 
integrating the multiplied results provides a 
three-dimensional clothoid curve, 
[0063] 

For the three-dimensional clothoid curve, the tangential 
vector has a pitch angle a and a yaw angle P which are given 
by a quadratic expression of the curve length variable as 
shown by Expressions (1-8) and (1-9), respectively. This 
enables free selection of changes of the tangential direction, 
while still giving continuousness to the changes. 
[0064] 

As represented by the above expressions, the 
three-dimensional clothoid curve is defined as ''a curve in which 
the pitch angle and the yaw angle of a tangential direction are 
expressed by a quadratic expression of a curve length variable, 
respectively. " 
[0065] 

A single three-dimensional clothoid curve starting from 
Po is decided with seven parameters composed of 
[Numeral 15] 

^1* ^2^ bo, b,, h (1-11) - 

The six variables of ao to b2 have the unit of angle and represent 
the shape of a clothoid curve. In contrast, h has the unit of 
length, which represents the amplitude of a clothoid curve. A 
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typical example of the three-dimensional clothoid curve is a 

spiral curve, as shown in Fig. 4. 

[0066] 

(1-2) Frenet frame and curvature on the 

three-dimensional clothoid curve: 

Let us assume that an arbitrary three-dimensional curve 
is expressed by R (t) v/hich uses t as a parameter , In particular, 
assume that this expression is denoted by R(s) which uses s as 
a parameter expressing a distance moving from a starting point 
of the curve. 
[0067] 

When the absolute values of relative* positional vectors 
dR(s) at two points on a curve, which provide a difference of 
ds, is regarded as a line element ds, there is a relationship 
between ds and dt, which is expressed by the following 
Expression (2-1) . For the sake of a simplified explanation, 
differentiating R with regard to a parameter t is denoted by 
a character with a dot atop thereof. 
[0068] 

[Numeral 16] 



ds = |dR(t)| = 



dR(t) 



dt 



dt = 



R 



= VRRdt 



(2-1) 



[0069] 

Since a unit tangential vector u(t) is created by 
normalizing a line element vector dR(t) of a curve, the unit 
tangential vector can be expressed by Expression (2-2) with 
reference to Expression (2-1). 
[0070] 
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[Numeral 17] 



u(t) = 



dR (t) dR (t) R 



|dR (t)| ds R(t) 



(2-2) 



[0071] 

A change amount du of the unit tangential vector will then 
be considered. Fig, 5 shows a change amount of a unit normal 
vector. For a linear line^ the tangential direction is constant, 
resulting in du(t)={0, 0, 0}. This is not true of curves, 
however. The change amount du of a unit tangential vector at 
a position distant from by a distance ds is perpendicular to 
a normal vector u. This also clearly understood from the fact 
that differentiating a relationship of u-u=l provides an 
orthogonal relationship of u-du=0. The normalization of the 
change amount du of this unit tangential vector creates a unit 
principal normal vector n(t). That is, the unit principal 
normal vector n(t) is expressed by Expression (2-3). 
[0072] 

[Numeral 18] 

^ (t) 

n(t) = T (2-3) 

V ^ I u(t) I 

[0073] 

The normal direction is treated such that a leftward 
direction to be obtained when a person turns to a tangential 
direction is regarded as being a positive normal direction. To 
be more accurate, in a plane formed by both the vector du and 
the unit tangential vector u(t), a direction created by a 
counterclockwise rotation of 90 degrees from the unit 
tangential vector u(t) is defined as a positive direction to 
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the unit principal normal vector n(t). 
[0074] 

In addition, a binormal vector b(t) is a vector 
perpendicular to both the unit tangential vector u(t) and the 
unit principal normal vector n(t) and is defined by Expression 
(2-4) . 
[0075] 

[Numeral 19] 

b(t) = U(t) X n(t) (2-4) 
[0076] 

A set of three vectors [u(t), n(t), b(t)], which is a 
combination of the unit tangential vector u(t) , unit principal 
normal vector n (t ) , binormal vector b (t) which are defined above, 
is referred to as frenet frame at a position R(t) on a curve. 
[0077] 

A curvature k will now be described, which is a ratio at 
which the unit tangential vectors are turned along the linear 
elements of a curve. A three-dimensional curvature is defined 
by Expression (2.5). 
[0078] 

[Numeral 20] 



R(t) X R(t) 



R(t) 



(2-5) 



[0079] 

As defined above, the fundamental amounts concerning the 
three-dimensional curve are denoted with the expressions that 
use the curve length variable S as a parameter in the 
three-dimensional clothoid curve. 
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[0080] 

When any three-dimensional clothoid curve P{S) is 
considered, the unit tangential vector u(S) can be expressed 
by Expression (2-6) with the help of Expression (2-2) . 
[0081] 

[Numeral 21] 
[0082] 

In addition, when taking the definition Expressions (1-7) , 
(1-8) and (1-9) of the three-dimensional clothoid curve into 
account, the unit tangential vector u(S) can be expressed in 
the form of Expression (2-7) as well- In the present 
specification, this expression is used as a main expressing way. 
[0083] 

[Numeral 22] 

COS /?(S)cos a (Sy 



u(S) = 



sin /7(S)cos a (S) 
- sin a (S) 



(2-7) 



[0084] 

The differential coefficient of first order of the 
tangential vector u(S) of a three-dimensional clothoid curve 
with respect to the curve length variable S creates Expression 
(2-8) and its amplitude is expressed by Expression (2-9) . 
[0085] 

[Numeral 23] 
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U'(S) = 



-a'(S)cos /?(S)sin a(S)->^'(S)sin /?(S)cosa(S) 
- a' (S) sin /^(S) sin a(S) - /?' (S) cos y^(S) cos a(S) 

-a'(S)cos a(S) 



||u'(S)|| = V^'(S)2 +y^'(S)^cos 2 a(S) 



(2-8) 



(2-9) 



[0086] 

The unit principal normal vector n(S) will now be 
considered. The normal vector to a three-dimensional curve is 
expressed by Expression (2-3) , so that the normal vector to a 
three-dimensional clothoid curve is to be expressed by 
Expression (2-10) . 
[0087] 

[Numeral 24] 



n(S) = 



u'(S) 

^•(S)|| 



1 



^]a'(Sf + ^'(Sf cos^ a(S) 



'-a'(S)cosy^(S)sina(S)-/?'(S)siny^(S)cosa(S) 

- a' (S) sin /?(S) sina(S) + jS" (S) cos ^S) cosa(S) 
-a'(S)cosa(S) 

(2-10) 

[0088] 

As to the binormal vector b(t). Expression (2-4) is used 
to obtain the binormal vector using both the unit tangential 
vector u(S) on Expression (2-7) and the unit principal normal 
vector n(S) on Expression (2-10). 



[0089] 
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[Numeral 25] 

b(S) = u(S)x n(S) {2-11) 
[0090] 

Finally, as to the curvature. Expression (2-5) is 
deformed to express the curvature as shown in Expression (2-12) . 

[0091] 

[Numeral 26] 



|u'(S)|| ^ ^fa\S)^ + ^\sf cos ^ a(S) 
||P'(S)f ' h " h 

(2-12) 

[0092] 

As described above, the frenet frame and the curvature 
k at each point on a three-dimensional clothoid curve can be 
obtained by the curvature length variable S. 
[0093] 

(1-3) Production of three-dimensional clothoid curve 
having opposite direction: 

As shown in Fig. 6, the production of the 
three-dimensional clothoid curve whose amplitude and shape are 
the same and direction is opposite as and to those of a selected 
three-dimensional clothoid curve will now be explained. 
[0094] 

Assume that there is a three-dimensional clothoid curve 
Ci which has a starting point Ps and an end point P© and has 
clothoid parameters for a three-dimensional clothoid curve 
which are decided by seven values made up of h, ao, ai, 32, bo^ 
bi and b2 - In such a case, tangential rotation angles ai and 



|P'(S)x P"(S) 
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pi are expressed by the following Expressions (2-13) and (2-14). 



[0095] 



[Numeral 27] 



2 



(2-13) 



J3i =bo+biS + b2S^ 



(2-14) 



[0096] 



In the three-dimensional clothoid curve C2 having the same 
size and shape and the opposite direction as and to those of 
this three-dimensional clothoid curve, P's=Pe and P'e=Ps aire 
accomplished, wherein the curve C2 has a starting point P's and 
an end point P'e- When a curve length h is first considered, 
the curve lengths of the curves Ci and C2 are mutually equal, 
because the sizes are equal to each other. When the fact that 
a tangential line t to the three-dimensional clothoid curve C2 
is oppositely directed to a tangential line t to the 
three-dimensional clothoid curve Ci whose coordinates are 
always the same is considered, it is understood that the 
following relationships exist between the tangential rotation 
angles ai and pi of the curve Ci and the tangential rotation angles 
a2 and p2 of the curve C2. 
[0097] 

[Numeral 28] 



The above-described expressions can be summarized into 
an equation on the following Expressions (2-17) and (2-18) . 



^2(8) = a,(l-S) + ;r 
>52(S) = A(l-S) 



(2-15) 



(2-16) 



[0098] 
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[Numeral 29] 

^2(8) = (ao + aj + a2 + ^) - (ai + 2a2)S + a2S^ (2-17) 

/?2(S) = (bo + b, +b2)-(bi +2b2)S + b2S^ (2-I8) 
[0099] 

These expressions allow the remaining parameters to be 
decided, so that the clothoid parameters of the curve C2, which 
are h' , a'o/ a' 1, a'2. b'o. b'l, and b'2/ can be expressed using 
the parameters of the curve Ci . 
[Numeral 30] 

P' = P 
^ s ^ e 

a; = -(ai + 2a2) 
a 2 — a 2 

bo = bo +bi +b2 

b; = "(bj +2b2) ^2-19) 

b2 = b2 
h'= h 

[0100] 

The use of this relationship produces a three-dimensional 
clothoid curve of which size and shape are the same and direction 
is opposite. 
[0101] 

(1-4) Division of three-dimensional clothoid curve 
Let us assume that there is a three-dimensional clothoid 
curve Co which have not only a starting point Pi and an end point 
P2 but also clothoid parameters decided by seven quantities h^ 
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ao, ai, a2, bo, bi and b2. In this case, how to divide the 
three-dimensional clothoid curve Co connecting both of the 
points Pi and P2 into curves Ci and C2 divided at a point Pm 
providing a curve length parameter S=Sd, as shown in Fig. 1, 
will now be described. 
[0102] 

Of the divided curves, the curve CI having the starting 
point PI will first be described. With respect to its curve 
length h, the definition of a three-dimensional clothoid curve 
gives the fact that the curve Ci has a curve length hi equal 
to Sd times larger than a curve length ho of the curve Cq. Further, 
when it is assumed that a curve length variable of the curve 
Co is denoted by So and a curve length variable of the curve 
Ci is denoted by Si and those variables mean points on the same 
curve Ci, the following relationship is accomplished among these 
quantities . 
[0103] 

[Numeral 31] 

S 1 = S d S 0 (2-20) 
[0104] 

Namely, between tangential rotation angles ao and Po and 
tangential rotation angles ai and pi, it is understood that the 
following relationships exist. 
[0105] 

[Numeral 32] 

ai(Si) = ^o(SdSo) 

/?i(Si) = /?o(SdSo) ^^-^'^ 



44 



[0106] 

Arrangement of these expressions leads to the equations 
in the following Expressions (2-22) . 
[0106] 

[Numeral 33] 

a, (S) = ao + ajSjS + a2Sd^S^ 

A(S) = bo + bjSdS + b2Sd's2 ^2-22) 

[0108] 

These expressions define tangential directions, so that 
the clothoid parameters h' , a'o/ a'l. a' 2/ b'o^ b'l, and b'2 of 
the curve Ci can be expressed by the following Expression (2-23) 
that uses the parameters of the curve Co- 
[0109] 

[Numeral 34] 



[a'o 


= ao 


a', 


= a,Sd 


a 2 


= a 2S d ^ 




= bo 


bi 


= b,Sd 


b'z 




h' 


= hS d 



(2-23) 



[0110] 

The curve C2 of which starting point is served by the 
dividing point will then be described. As to this curve Czr 
the production can be achieved by combining the technique for 
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producing a curve having the same size and shape but the opposite 
direction, described in the foregoing section 1-3, with the 
technique for producing the curve Ci • 
[0111] 

First of all, let us assume that a curve of which size 
and shape are the same as those of the curve Co but of which 
direction is opposite to that of curve Co is given by a curve 
C'q. On this curve, a dividing point P^, is expressed by Pm^ 
C'o(l-Sci)- Let us assume again that the curve C'o is divided 
at the point Pm- In that case, of the divided curves, a curve 
C'2 starting at a point P2 has the same size and shape as those 
of the curve C2 but has the opposite direction to that of the 
curve C2 . Because both techniques described in the forgoing 
section 1-3 and used in the production of the curve Ci allow 
the curve C'2 to be produced, applying the technique described 
in the section 1-3 to the curve C'2 makes it possible to produce 
the curve C2 . 
[0112] 

Thus this curve C2 has clothoid parameters h", a"o, a"i, 
a"2f b"o, b"i, and b"2 which can be expressed by using the 
parameters of the curve Cq, as shown in the following Expression 
(2-24) . 
[0113] 

[Numeral 35] 
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a'o = ao + aiSd + a2Sd^ 
a;' = (l-Sd){ai+2a2Sd} 

a2=a2(l-Sd)' 

< =bo + biSd + b2Sd^ 
bl' = (l-Sd){bi+2b2Sd} 

T (2-24) 
b'^ =b2(l-Sd)^ 

h" = h(l-Sd) 

As stated above, a curve can be divided into a curve Ci 
and a curve C2 at a dividing point Pm providing the curve length 
variable S=Sci on a three-dimensional clothoid curve Co- 
[0114] 

(1-5) Characteristics of the thee-dimensional clothoid 

curve : 
[0115] 

(a) Continuity of the curve: 

In the case of a single clothoid curve (i.e., a clothoid 
curve represented by the same parameters) , pitch angles and yaw 
angles made by its tangential directions are given by quadratic 
expressions with a curve length variable S, respectively. Thus 
it is guaranteed that normal directions obtained by applying 
differential coefficient of first order to the quadratic 
expressions and curvatures to be obtained by two-time 
differential to that are continuous with the respect to the 
curve length variable S. In other words, each one clothoid 
curve has normal lines and curvatures, which change 
continuously along the one clothoid curve. Accordingly a smooth 
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and good quality curve can be obtained. In the case that two 
clothoid curves are mutually connected, it is sufficient to 
select parameters to permit tangential lines, normal lines, and 
curvatures to be continuous at their connecting point. This 
selection manner will produce a one smoothly connected line, 
called a clothoid curve group. 
[0116] 

(b) Applicabi lity : 

Because the tangential directions of curves can be swung 
with changing two angles (pitch angle and yaw angle) , an 
arbitrary three-dimensional curve can be produced in conformity 
with various conditions for various applications. Thus it is 
possible to provide a wide use .spatial curves necessary for 
designing industrial products. In cases where an object moves 
at accelerated and decelerated speeds along a spatial curve, 
it is possible to work out a design such that changes in a binding 
force are smooth. In addition, changes in the curvature to the 
curve length can be designed properly, effective applicability 
can be achieved in va^rious industrial fields, such as production 
of aesthetic design curves. 
[0117] 

(c) Consistency with Geometric curves: 

Geometric curves , such as liner segments , circular arches , 
and screw curves, can be produced by giving zero to some of the 
clothoid parameters or giving particular functional 
relationships to some of the parameters. The curves to be 
produced in those ways are a kind of clothoid curves, so that 
they can be expressed in the format of clothoids. 
[0118] 
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Furthermore, by replacing either a or (3 at any time, a 
two-dimensional clothoid can be made. Thus, resources which 
have already been acquired concerning the two-dimensional 
clothoid can be utilized well, 
[0119] 

That is, proper setting of a or p makes it possible to 
express individual curves, such as circular arches and liner 
segments, including the already known two-dimensional clothoid 
Such respective curves can be expressed by using the expressions 
having the same format as that for expressing the 
thee-dimensional clothoid curve, thereby simplifying the 
computation procedures . 
[0120] 

(d) Good perspective: 

In mathematizing free curves using the conventional 
interpolation techniques including the spline interpolation, 
it is frequent that the whole shape or a local shape is difficult 
to understand. In contrast, for using the three-dimensional 
clothoid, it is possible to imagine each of a pitch angle and 
a yaw angle, with the result that the whole shape can be grasped 
in a relatively easier manner. 
[0121] 

In addition, on completion of expressing a curve as a 
clothoid curve, the line lengths, tangential directions, 
curvatures thereof have been known. Thus, unlike the 
conventional interpolation techniques, there is no need for new 
computation. Namely, correspondingly to the parameters S for 
a curve, the tangential lines, normal lines, and the curvature 
of the curve can be obtained in a direct manner, as shown in 
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Expressions in (1-7), (2-10) and (2-12). 
[0122] 

(e) Easiness of motion control: 

The main variable of a curve is the length s or the 
normalized length S, and the equation of this curve is given 
by a natural equation with regard to the length. Hence, by 
defining the length 3 as a function of the time t, an arbitrary 
characteristic of motion, which is for example an accelerated 
and decelerated motion, can be given. By employing motion 
curves having good characteristics, which have conventionally 
been used for cams, processing operations can be made faster. 
The length s is given as a value in the existing Cartesian space 
and velocity and acceleration are calculated in tangential 
directions, resulting in that it is not necessary to synthesize 
values given every axis, unlike the conventional interpolation 
method. Additionally, the curvature can be calculated with 
easiness, whereby a centrifugal acceleration of an object in 
motion can be obtained with easiness. Thus control can be 
conducted depending on motion trajectories. 
[0123] 

2. Interpolation method using a three-dimensional 
clothoid curve : 
[0124] 

(2-1) Mathematical conditions with smooth connection: 
A single three-dimensional clothoid curve has a 
limitation on expressing the shapes of curves . In this section, 
with employing the numerical control of motion of a machine tool 
as a main purpose, a plurality of three-dimensional clothoid 
curves (three-dimensional clothoid segments) are mutually 
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connected for designing industrial products. Hereinafter, the 
interpolation that uses a three-dimensional curve is referred 
to as a three-dimensional clothoid interpolation and a group 
of curves to be produced by the interpolation is referred, as 
a whole, to as a three-dimensional clothoid curve, which is 
composed by a plurality of unit curves each referred to as a 
three-dimensional clothoid segment . 
[0125] 

When two three-dimensional clothoid segments are 
smoothly connected at their end points, this results in a 
definition that their end positions, tangential lines and 
curvatures are continuously connected, respectively. Using 
the foregoing definition expressions, conditions for those 
connections can be described as below, in which the first three 
expressions show the continuity of positions, the next two 
expressions show the continuity of tangential lines, the next 
one expression shows the agreement of normal lines, and the last 
expression shows the continuity of curvatures. 
[0126] 

[Numeral 36] 

PXi(l) = PXi^,(0) 

Pyi(i) = Pyi-.i(0) 

PZi(l) = Pzi^,(0) 
«i(l) = ai^,(0) 

>^i(l) = A+i(0) 
tanyi(l) = tanyi+,(0) 

A^ia) = ^i+i(0) 

[0127] 
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These expressions provide sufficient conditions for 
achieving the continuity of tangential lines, normal lines, 
curvatures, and a and P at connecting points, and in some cases, 
these conditions are too strict to be applied. By taking such 
conditions into consideration, those conditions can be changed 
so as to meet the conditions in an original viewpoint, and the 
changed expressions are as follows. 
[0128] 

[Numeral 37] 

Px i(l) = Px i^,(0) 

Py i(i) = Py i-M(O) 

PZi(l) = Pz i^i(O) 

COS[ CXi(\) - Qfi + l (0)] = 1 

cos[ J3,(l) - /?i^i(0)] = 1 ^'"^^ 
tan 7 i (1) = tan 7 j + j (0) 

[0129] 

Further, when a relationship of 
[Numeral 38] 

cos[ai(l)-«i^i(0)] = l 

is taken into account, 
[Numeral 39] 

tan 7i(l) = tan7i^.i(0) 

is replaced by the following conditions, 
[Numeral 4 0] 
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tan yi(l) = 101171+1(0) 

Q^'i (1) ^ ^'iH-l (0) 

y^'i (1) COS a; (1) >^'i+i (0) cos ^i+i (0) 
V < (0) = ^^'i+i (0)>^i (1) 

As a result, it is understood that satisfying the 
following conditions leads to achievement of the object- 
[0130] 

[Numeral 41] 

Pxi(l) = Pxi^i(0) 

Pyi(i) = Pyi-.i(0) 

PZi(l) = Pzi^,(0) 
cos[ai(l)-ai+i(0)] = l 

cos[A(l)-/?i^i(0)] = l ^3-3) 

«iXl)AVi(0) = aiVi(0)>^i'(l) 
;ri(l) = /ri^,(0) 

[0131] 

In Expression (3-3) , the first three expressions show the 
continuity of positions, the next two expressions show the 
continuity of tangential directions, the next one expression 
shows the agreement of normal lines, and the last expression 
show the continuity of curvatures, respectively. To perform 
a G^-continuous interpolation, it is required that two 
three-dimensional clothoid curves should meet the seven 
conditional expressions in Expression (3-3) at their end 
points . 
[0132] 

The G^ continuity (G stands for the acronym of Geometry) 
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will now be complemented. Fig. 8 illustrates conditions 

required for the G^-continuous interpolation. 

[0133] 

G*^ continuity is that two three-dimensional clothoid 
curves positionally agree with each other at their end points, 
continuity is that tangential directions of those agree with 
each other, and G^ continuity is that osculating planes (normal 
lines) and curvatures respectively agree with each other. In 
Table 1 shown below, comparison will now be made between C°-C^ 
continuity used by spline curves and G°-G^ continuity used in 
clothoid curves according to the present invention. 
[0134] 



[Table 1] 



C^: positions 


G°: positions 


C^: the primary 
differential 

coefficients 


G^: tangential directions 


C'^ : the secondary 
differential 
coefficients 


G2: osculating planes 
(normal 

lines) and curvatures 



[0135] 



In terms of consideration of the continuity of two 
three-dimensional clothoid curves, the interpolation 
conditions are made more stricter as the continuity degrees 
advance from C° to C\ and to and from G° to G^ and to G^ . 
Though the continuity requires that the size and direction 
of the tangential lines agree with each other, it is sufficient 
that the G^ continuity requires the agreement of only the 
tangential directions. For smoothly connecting the tangential 
lines between two three-dimensional clothoid curves, it is 
preferable to create the conditional expressions on the G"^ 
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continuity. Creating conditional expressions based on the 
continuity, like the spline curves, results in too strict 
conditions, because the creation inevitably involves with a 
condition that the sizes of tangential lines should be made 
agree with each other, even though such a condition has no 
geometrical relationship. Creating the conditional 
expressions on the G"^ continuity is advantageous in that the 
amplitudes of primary differential coefficients are set to any 
values freely. 
[0136] 

In the continuity, osculating planes (i.e., normal 
lines) are made to agree with each other. The osculating planes, 
as shown in Fig. 9, mean planes SI and S2 in which a curve C 
is included locally. In Fig. 9, an example is shown where the 
osculating planes SI and S2 are discontinuous at a point P, 
regardless of the continuity of the tangential directions kept 
at the point P. When consideration is given to the continuity 
of thee-dimensional curves, the matter which comes next to the 
agreement of tangential directions is an agreement of 
osculating planes. A discussion of curvatures should be based 
on an agreement of the osculating planes, and if not so, the 
discussion is meaningless. Making the osculating planes agree 
with each other should precede making the curvatures agree with 
each other. A condition satisfying the G^ continuity is that 
the coordinates, tangential directions, osculating planes 
(normal lines), and curvatures are respectively made to agree 
with each other betv/een two three-dimensional curves. 
[0137] 

(2-2) Practical computation procedures: 
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There are provided two types of computation procedures. 

[0138] 

(a) By setting the parameters h, a and p of a curve to 
produce a single three-dimensional clothoid curve, the 
parameters of the next three-dimensional curve are decided to 
meet Expression (3-3) at an end point of the produced curve. 
In this way, three-dimensional clothoid curves connectable in 
turn in a smooth manner can be produced. Using these 
computation procedures, the curve parameters can be computed 
easily, and a solution on this computation way is called a 
sequential solution. This computation way enables the 
production of a variety of shapes of curves in an easier manner, 
but it is impossible to explicitly specify the connecting points 
through which the curves pass. 

[0139] 

(b) In order that a group of points specified in advance 
may compose the connecting points of curves, three-dimensional 
clothoid curves can be connected to each other. In this section, 
there is provided an example in which a short clothoid curve 
(clothoid segment) is produced for every span in a row of points 
given discretely. In such a case, the computation procedures 
to decide the curve parameters so as to meet Expression (3-3) 
is more complicated than that described in the foregoing item 
(a), requiring a repeated convergence computation. This 
computation involves a series of inverse procedures that the 
curve parameters are decided from connecting conditions, so 
that a resultant solution is called an inverse solution. 
[0140] 

Concerning the inverse solution in the above item (b) , 
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how to compute will now be detailed. A question to be solved 
is formulated as follows: 

Unknown parameters: curve parameters 

Constraint conditions: Expression (3-3) or part thereof 

[0141] 

Depending on questions to be solved, the number of 
constraint conditions is changed and curve parameters of which 
number corresponds to the number of constraint conditions are 
set as unknown parameters. For example, in the case that the 
continuity of curvatures is not demanded, part of the curve 
parameters can be adjusted freely. Alternatively, when it is 
demanded those curvatures are kept continuous but tangential 
directions are specified, it is required that the number of 
three-dimensional clothoid curves to be used for the 
interpolation be increased by division so as to increase the 
number of corresponding unknown curve parameters. 
[0142] 

In order to converge the above repeated convergence 
computation in a stabilized manner, the computation should be 
cogitated. To avoid the computation from diverging for 
speeding up the convergence, setting optimum initial values of 
the unknown values is effective. For doing so, it is effective 
to gain initial values for the repeated convergence computation 
by generating a simpler interpolation curve (for example, such 
a curve is a linear spline curve) , which still meets constraint 
conditions concerning given connecting points and/or others, 
estimating the shape of the curve to obtain curve parameters 
of three-dimensional clothoid curves, and using such curve 
parameters as the initial values. 
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[0143] 

Alternatively, without requiring constraint conditions 
to be met at once, a technique by which conditional expressions 
are increased sequentially is still effective as the way for 
gaining a solution with stability. For example, the procedures 
for generating a curve are divided into the following three 
steps, which are executed in sequence. In the first step, 
interpolation is made such that pieces of positional 
information agree with each other and also tangential 
directions agree with each other. In the second step, 
interpolation is made to allow normal lines to agree with each 
other, and in the third step, interpolation is also made to allow 
curvatures to agree with each other. This technique is outlined 
as a flowchart in Fig. 10. The necessary three-dimensional 
clothoid curve equations and the definition equations for the 
tangential lines, normal lines, and curvatures thereof have 
already been explained. 
[0144] 

(2-3) Embodiment of the interpolation method using the 
three-dimensional clothoid curve: 
[0145] 

(a) Flow of interpolation method: 

One embodiment of the technique with which a 
three-dimensional clothoid curve is used to smoothly 
interpolate each interval between points which are part of a 
row of points will now be detailed. 
[0146] 

The basic flow of the three-dimensional clothoid 
interpolation is such that the respective parameters of a 
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three-dimensional clothoid segment connecting two points being 
interpolated are set to unknowns, and a curve is produced by 
obtaining a solution with the Newton-Rapson method, in which 
the solution meeting the conditions that points being 
interpolated are passed strictly and the continuity is kept. 
This way is outlined as a flowchart in Fig. 11. The 
continuity is that, with regard to two three-dimensional 
clothoid curves, the potions, tangential directions, normal 
directions, and curvatures at end points of the curves agree 
with each other parameter by parameter. 
[0147] 

(b) Conditions of G^-cont inuous interpolation: 
Practical conditions which allow points being 

interpolated to be passed strictly and the G^ continuity is kept 

will now be described, 

[0148] 

Now assume a simple case in which there are three points 
Pi={Pxi, Pyi, Pzi}, P2={Px2, Py2, Pz2}, and P3={Px3. Py3. Pzs) and 
these points are interpolated by using three-dimensional 
clothoid segments. Fig, 12 shows the three-dimensional 
clothoid interpolation between among the points Pi, P2 and P3. 
When a curve connecting the points Pi and P2 is denoted as a 
curve Ci and a curve connecting the points P2 and P3 is denoted 
as a curve C2, the unknowns in this case are 14 pieces consisting 
of the parameters from the curve Ci, which are aOi, ali, a2i, 
bOi, bli, b2i, and hi, and the parameters from the curve C2, which 
are a02. al2, a22, b02, bl2, b22, and h2 . The subscripts to each 
character, which will appear in the following description, 
correspond to the subscript to each curve. 
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[0149] 

Here, the conditions which allow points being 
interpolated to be passed strictly and the continuity is kept 
will now be considered. First of all, when the condition which 
allows points being interpolated to be passed strictly at a 
starting point is necessarily achieved at the time when the 
starting point is specified, so that the interpolation 
condition is not necessary in this situation, which is clear 
from the definition of the three-dimensional clothoid curve. 
At the connecting point PI, seven interpolation conditions 
consisting of three positional conditions, two tangential 
vector conditions, and two conditions (about the magnitude and 
direction) regarding to equations showing the curvature 
continuity are needed. Further, as to the end point, three 
positional conditions are necessary at the point P2 . Thus, the 
conditional expressions total to 10. However, the number of 
unknowns is 14, compared to only the ten conditional expressions, 
so that the unknowns cannot be solved. In order to overcome 
this difficulty, the study according to the present invention 
was conducted on condition that tangential line vectors were 
given at both end points to increase the number of conditions 
at each end point by two so that the conditional expressions 
and the unknowns are equal in number to each other. In addition, 
deciding a tangential direction at the starting point enables 
aOi and bOi to be obtained from the equation defining the 
tangential direction. Considering this, aOi and bOi were not 
treated as unknowns. In the following, consideration will now 
be given to each condition. 
[0150] 
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First, the positional conditions will now be considered. 
In this case, three Expressions (4-1), (4-2) and (4-3) are 
established (hereinafter, ''i'' represents non-negative 
integers smaller than 3) . 
[Numeral 42] 

Pxj +hi r^cos(aOi +aliS + a2iS^)cos(b0i +bliS + b2iS^)dS-Pxi+i 

JO 



(4-1) 

Py, +hi f'cos(aOi +aliS + a2iS^)sin(b0i +bliS + b2iS^)dS-Py 

JO 

(4-2) 

Pz i + hi f'(-sin( aOi + aljS + a2iS^))dS - Pz ; + , = 0 

J 0 

(4-3) 

[0151] 

The, the conditions concerning the tangential directions 
will now be considered. In this case, two Expressions (4-4) 
and (4-5) are established. 
[Numeral 43] 

cos(aOi + alj + a2i - aOj+j) = 1 (4-4) 
cos(bOi +bli +b2i -bOj+i) = 1 (4-5) 

[0152] 

Concerning the curvature k, the following Expression 
(4-6) will now be established. 
[Numeral 44] 

^i(l)-^i + l(0) = 0 (4-6) 
[0153] 

Finally, the normal direction vector n will now be 
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considered. The normal vector n of a three-dimensional 

clothoid curve is expressed by Expression (2-10) . 

[0154] 

Like the decision of the tangential vector u of a 
three-dimensional clothoid curve, the rotation will now be used 
for considering the normal vector n. Assume that an initial 
tangential direction is (1, 0, 0) and an initial normal 
direction is expressed as (0, cosy, -siny) in which y is a 
constant. When this initial normal direction is rotated in the 
same way as that for tangential lines, the normal line n is 
expresses as shown in Expression (4-7) . 
[0155] 

[Numeral 45] 



COS a{S) 0 sin a(S) 
0 1 0 



- sin a(S) 0 cos a(S)j [- sin y 



0 

cos / 



cosj3(S) -siny^(S) 0 
n(S)= siny^(S) cos /?(S) 0 
0 0 1 

sin / cos /?(S)sin a(S) - cos / sin /?(S) 
= j - sin 7 sin /?(S) sin a(S) + cos / cos /?(S) 
- sin y cos a(S) 

(4-7) 

[0156] 

Making a comparison between Expressions (2-10) and (4-7) 
reveals that siny and cosy correspond to Expression (4-8) • 
[0157] 

[Numeral 46] 
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a'(S) 

Sin y = 



y/a'iSf + y5'(S)^ cos 2 a(S) 

y^'(S)cos a(S) ^^-^^ 

cos ^ = . 

VQr'(S)^ + y^'(S)^ cos ^ a(S) 

[0158] 

That is, it is found from Expression (4-8) that the 
continuity of tany is enough for accomplishing the continuity 
of the normal lines at a connecting point involving in the 
three-dimensional clothoid interpolation. 
[0159] 

[Numeral 47] 

^'(S) 

tan V = M-9) 

^ /?'(S)cosa(S) 

[0160] 

In short, it is understood that the condition for holding 
the normal lines continuous is expressed by Expression (4-10) . 

[0161] 

[Numeral 48] 

tan ri(^) = ri + i(0) (4-10) 

[0162] 

Further, when taking the equation of 
[Numeral 49] 

cos[a',(\) - ai+](0)] = 1 (4-11) 

into account, the conditional Expression (4-10) can be replaced 
by the following conditional Expression (4-12) . Specifically, 
the condition for the continuous normal lines is expressed by 
Expression (4-12) . 
[Numeral 50] 
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a\(l)j3\^^(0) = a^,^,(0)j3\il) (4-i2) 

[0163] 

In summary, it is found that the conditions for keeping 
not only a strict passage through points being interpolated but 
also the continuity at each connecting point are expressed 
by Expression (4-13) . Also, as for the starting and end points, 
it is still enough to select some of the conditions listed in 
Expression (4-13) . 
[0164] 

[Numeral 51] 

PXi(l) = PXi^i(0) 

Pyi(i) = Pyi-.i(0) 

PZi(l) = PZi^i(O) 

COS[ Qfi(l) - Q^i + i(0)] = 1 

cos[>^i(l)-A+i(0)] = l ^'"'^^ 
x-i(l) = ^iH-i(0) 

[0165] 

As described, it is revealed that concerning the 
conditional expressions for the twelve unknowns ali, a2i, bli, 
b2i, hi, a02, al2, a22, b02, bl2, b22, and h2, twelve conditional 
expressions are established as follows {, in which and P3 
represent rotation angles in the tangential direction at the 
point P3) . 
[0166] 

[Numeral 52] 
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PX,(1)= PX2(0) 

Pyi(i) = Py 2(0) 

PZ,(1)= PZ2(0) 

COS[ a,(l)-a2(0)] = 1 
COS[ y5,(l)-/?2(0)] = 1 

a\ (l)y^'2(0) = a'2(0)/?', (1) 

1^ ^ 2V y (4-14) 
PX2(1)= PX3(0) 

Py 2(1) = Py3(0) 

PZ2(1) = PZ3(0) 
COS[ <22(1)-«3] = 1 
COS[ /?2(l)-/?3] = 1 

[0167] 

Since the twelve equations can be given for the twelve 
unknowns, a solution can be obtained. Practically, the 
Newton-Rapson method is used to solve such equations to have 
a solution. 

[0168] 

Additionally, for the general case in which a row of 
n-piece points is subjected to the interpolation, it is 
sufficient that the non-negative integer i described above is 
expanded to values fulfilling i<n. The remaining matter 
concerns the number of unknowns and the number of conditional 
expressions . 
[0169] 

For example, suppose that there is a row of "n-l"-piece 
points and N-piece unknowns and N-piece relational expressions 
are established. In this situation, when one point is added 
to the point row, the parameters is thus subjected to an increase 
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thereof such that the seven clothoid parameters aOn. aln, a2n, 
bOn/ bin, b2n, and hn of the three-dimensional clothoid segments 
Pn-i and Pn are added. On the other hand, the conditional 
expressions are subjected to an increase of a total of seven 
equations consisting of three equations for positions at the 
point Pn-if two equations for a tangential vector, and two 
equations (about the magnitude and direction) representing a 
condition for keeping the curvatures continuous with respect 
to the point Pn-i, because the connecting points increase by one. 
[0170] 

In the case of n=3, it is known that the unknowns and the 
relational expressions are 12 in number respectively, so that 
for n>3, the number of unknowns is 7(n-2)+5 and the number of 
equations to be established is also 7 {n-2) +5 . In this way, the 
unknowns and the conditions relating to the unknowns are the 
same in number- Thus, in the case of a row of n-piece free points, 
the similar method to that applied to three points can be used 
to calculate a solution. The Newton-Rapson method that 
utilizes the fact that the relationships on Expressions (4-15) 
and (4-16) are established between the unknowns and the 
conditional expressions was used as a solving method for a 
solution. (The conditions are denoted by F, the unknowns by 
u, and an error Jacobian matrix by J.) 
[0171] 

[Numeral 53] 



A F 




(4-15) 



Au 



= [J]-' AF 



(4-16) 



[0172] 
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Accordingly it is understood that a row of n-piece points 
can be subjected to the three-dimensional clothoid 
interpolation in such a manner that points being interpolated 
are passed strictly and the continuity is kept. 
[0173] 

(c) Decision of initial values: 

The Newton-Rapson method needs to have adequate initial 
values to start the search for a solution. Although the initial 
values may be given based on any method, how to give the initial 
values will now be exemplified in the following. 
[0174] 

The interpolation requires that initial values of 
respective unknowns be decided from a row of points. In the 
present study, a polygon having four apexes between points of 
a row of points being interpolated, which is a simple form of 
a polygon Q composed of 3D Discrete Clothoid Splines made by 
Li at al., was produced, and the polygon Q was used to compute 
the initial values for decision thereof. Those 3D Discrete 
Clothoid Splines have a characteristic that the splines 
strictly pass points being interpolated and the curvatures 
change smoothly along the distance moved from a start point. 
In the present specification, the initial values for the 
three-dimensional clothoid interpolation are decided through 
computation with the use of a polygon Q made on 3D Discrete 
Clothoid Splines of r=4, as shown in Fig. 13. 
[0175] 

The 3D Discrete Clothoid Splines will now be complemented 
as follows. As shown in Fig. 14, a polygon P of which apexes 
are a row of points being interpolated is first made, and new 
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apexes are insertedly placed, the same number of pieces, 
between the apexes of the polygon Q so that a polygon Q meeting 
PczQ is made. Here suppose that the number of apexes of the 
polygon P is n-pieces. This supposition results in that the 
polygon Q has apexes whose number is ''rn'' pieces if the polygon 
is closed, but ''r(n-l)+l" pieces if the polygon is open. 
Hereinafter, each apex is denoted by qi, in which the subscript 
is a serial number starting from the starting point. A vector 
k is decided at each apex, where the vector has, as a direction, 
a binormal vector b and has, as a magnitude, a curvature k. 
[0176] 

In cases where Expression (4-17) , which is listed later, 
requiring the apexes be equidistant therebetween is met and a 
condition is established which is the nearest to a specific 
condition where the curvature is proportional to the distance 
moved from the starting point (i.e., the function shown in 
Expression (4-18) listed later is minimized) , a certain polygon 
Q is made, which is called 3D Discrete Clothoid Splines. 
[0177] 

[Numeral 54] 

|qi-iqih|qi+iqik (qi ^p) (a-id 

r-l 

Z ^^^ir+ii . i = {0...n-l}, A2ki=ki_i-2ki+ki+i 

i=l 

(4-18) 

[0178] 

In the case of the 3D Discrete Clothoid Splines, the f renet 
frame of each apex is already obtained, so that the parameters 
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ao and bo are computed based on the unit tangential vector t 
thereof. This tangential vector t has already been known at 
the time of obtaining the polygon Q, and both the vector t and 
the expressions of the tangential lines to the 
three-dimensional clothoid curve are used to obtain the 
tangential rotation angles a and P at the respective apexes of 
the polygon Q. Thus the initial values to be given to the 
parameters ao and bo of each curve are decided. In a 
three-dimensional clothoid segment starting from the stating 
point, the values thereof is given as the initial values. 
[0179] 

[Numeral 55] 

COS (3 cos a 
u = ^ sin cos a ^ (4-i9) 
- sin a 

[0180] 

In addition, when talcing it into consideration the fact 
that 3D Discrete Clothoid Splines allows its apexes to be 
aligned at equal distances, the point q^i+i in Fig. 13 can be 
approximately estimated as having a curve length variable S of 
1/4. In the similar way to this, the point q4(i+i)-i can be 
approximately estimated as having a curve length variable S of 
3/4. In consideration of these values together with the 
expression of a of a three-dimensional clothoid curve, the 
following Expression (4-20) is established. 
[0181] 

[Numeral 56] 
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slOai + — al4i + — 

3 f3^ 
a04i+-al4i+ - 

4 i^4 j 



a24j - a04i+] 



a24j = a04(i+i)_] 



(4-20) 



[0182] 

Since this expression is a two-dimensional simultaneous 
equation to which unknowns are al4i and a24i, this equation is 
solved to obtain the initial values of the parameters ai and 
32- Similarly to this, the initial values of the parameters 
bi and I02 can be decided. 
[0183] 

The remaining unknown to be handled in this section is 
the curve length h, of which initial value is computed using 
the expression of the curvature of the three-dimensional 
clothoid curve. The curvature of a three-dimensional curve is 
expressed by Expression (4-21) . 
[0184] 

[Numeral 57] 



COS ^ a 



(4-21) 



[0185] 

This expression is deformed into Expression (4-22) , which 
gives a decided initial value. 
[Numeral 58] 
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4i +2a24i)^ +(bl4i +2b24i)^ cos^(a04i +al4i +a24i) 
h4i - - 

^4(i + l) 

(4-22) 

[0186] 

As described above, the initial values of the seven 
three-dimensional clothoid parameters can be decided. Using 
these decided initial values under the condition that the 
continuity described in the item (b) is still held, respective 
approximate values of the parameters of each curve were obtained 
by the Newton-Rapson method. The resultant parameters are used 
to produce three-dimensional clothoid segments, and each 
interval between any two points was subjected to interpolation 
on the three-dimensional clothoid curves. 
[0187] 

(d) Example of interpolation: 

An example of the interpolation will now be described, 
in which the foregoing technique was actually applied to the 
three-dimensional clothoid interpolation directed to four 
points of (0.0, 0.0, 0.0), (2.0, 2.0, 2.0), (4.0, 0.0, 1.0), 
and (5.0, 0.0, 2.0). A perspective view of the 

three-dimensional clothoid curve produced by the interpolation 
is illustrated in Fig. 15. Fig. 15 shows a solid line curve 
representing the three-dimensional clothoid curve and linear 
lines depicted by broken lines, dashed lines and chain 
double-dashed lines representing patterns of changes in the 
curvature radius in which, at each point on the curve, an 
amplitude is shown in the logarithm (curvature radius + 
logarithm natural e) and a direction is shown in the normal 
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vector . 
[0188] 

Furthermore, Table 2 represents the parameters of each 
curve, while Table 3 lists shifts of the coordinate, tangential 
line, normal line and curvature at each connecting point. These 
tables reveal that a three-dimensional clothoid curve which 
meets the requirement for the continuity at each connecting 
point was produced. Fig. 16 is a graph showing changes in the 
curvature, in which the axis of abscissas represents the 
distance moved from the starting point and the axis of ordinate 
represents the curvature. 
[0189] 
[Table 2] 

Parameters of each three-dimensional clothoid segment 
Curve 1 (curvature radius change pattern: broken lines) 

a= -0.657549 - 1.05303S + 1.845843^ 

|3= 1.03297 + 1.29172S - 2.551183^ 

h = 3.82679 

Po = (0.0, 0.0, 0.0) 

Curve 2 (curvature radius change pattern: dashed lines) 
a= 0.135559 + 2.185373 - 2.698713^ 
(3= -0.226655 - 3.156033 + 3.032983^ 
h = 3.16932 
Po= (2.0, 2.0, 2.0) 



Curve 3 (curvature radius change pattern: chain 
double-dashed lines) 
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a= -0.377569 - 1.45922S + 0.9849453^ 
(3= -0.349942 + 1.32198S - 0.8732673^ 
h = 1.43987 
Po= (4.0, 0.0, 1.0) 

[0190] 
[Table 3] 



3hifts of coordinate, tangential line, normal line and 
curvature at each connecting point 

Connecting point at which curves 1 and 2 are mutually 

connected 

Coord: ( 1-16 x 10"^ 2.00 x lO'S 3.82 x 10'® ) 

Tvector: ( 7.59 x 10'^, 1.50 x 10"^ 2.95 x 10'^ ) 

Nvector: ( 2.93 x 10"\ 9.19 x 10"^ -7.57 x 10"^ ) 

Curvature: 3.06 x 10"'' 

Connecting point at which curves 2 and 3 are mutually 

connected 

Coord: ( -4.33 x 10"^, -1.64 x 10"^, 1.11 x 10'^ ) 

Tvector: ( 2.06 x 10"S 2.33 x 10"% 1.97 x 10"" ) 

Nvector: ( 3.30 x 10"*., 1.19 x 10"% -3.23 x 10"^ ) 

Curvature: 5.96 x 10'^ 



[0191] 

(2-4) G2-continuous three-dimensional clothoid 

interpolation in consideration of control of value at each of 
both ends: 
[0192] 
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(a) Interpolation conditions and unknowns: 
As stated in section 2-3, if a curve is open and there 
are n-piece points being interpolated, the row of points can 
be interpolated three-dimensionally with the help of n-1 piece 
curves. If it is requested that the curves pass each point in 
a strict manner, the unknowns of each three-dimensional 
clothoid segment are seven in number, which are ao, ai, a2, bo/ 
bi, b2, and h. Accordingly, as a whole, the number of unknowns 
is 7(n-l) pieces. Meanwhile, the number of conditional 
expressions total to 7(n-2)+3 pieces, because there are seven 
unknowns concerning the coordinates, tangential line, normal 
line and curvatures at every n-2"-'piece connecting points, 
and there are three coordinates at the end point. In the 
technique in section 2-3, tangential vectors at each of the 
starting and end points were added to the conditional 
expressions so that the conditions increase by four, whereby 
the conditional expressions and the unknowns were made to be 
mutually equal in number. 
[0193] 

In cases the tangential line, normal line and curvatures 
are controlled at each of the starting and end points and the 
interpolation is conducted with the continuity still held, 
the conditions increase by 2 pieces, which are with respect to 
the normal line and curvatures at each of the starting and end 
points, that is, an increase of a total of 4 pieces, compared 
to the case where the control of tangential lines is made at 
both ends. In short, the number of conditional expressions 
totals to 7n-3 pieces. In this case, the unknowns are smaller 
in number than the conditions, the Newton-Rapson method is 
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unavailable for a solution. Hence any technique has to be used 

to increase the number of unknowns. 

[0194] 

In the present case, the above difficulty was overcome 
by newly inserting points being interpolated so that the 
unknowns and the conditional expressions became equal in number 
to each other. For instance, the number of unknowns is larger 
than the conditional expressions by 4, two new points are 
inserted and two of the coordinates at the perspective points 
are handled as unknowns. 
[0195] 

In this case, since the connecting points increase by 2, 
the conditions increase by a total of 14-piece ones, which 
consist of 7-piece conditions (coordinates, tangential line, 
normal line and curvatures) for each connecting point. On the 
other hand, the unknowns increase by 2 which is for each 
three-dimensional clothoid segment, the unknowns increase as 
a whole by 14 pieces, which is composed of 7 pieces of ao/ ai, 
3i2f bo, bi, b2, and h.for each segment. In this case, the number 
of points included in the row of points is n+2 pieces, the whole 
unknowns are 7(n+l) pieces and the whole conditional 
expressions are 7(n+l)+4 pieces. Further, when it is supposed 
that two of the coordinates of the newly inserted points are 
treated as unknowns, the number of unknowns results in an 
increase of 4 . As a result, the unknowns and the conditional 
expressions are both 7 (n+2) -3 in number, whereby a solution of 
the unknowns can be obtained. In this way, inserting new points 
makes it possible to perform the interpolation with the 
respective points passed strictly, the continuity held, and 
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the tangential lines, normal lines, and curvatures at both end 

points controlled . 

[0196] 

Furthermore, a generalized case will be discussed. In 
the case of interpolating a row of n-piece points in a state 
where m-piece items are controlled at both end points, 
consideration is given to the number of points to be inserted 
and to the number of coordinates to be treated as the unknowns 
at each inserted point. As state previously, as long as a curve 
is open, a row of points can be interpolated with the help of 
''n-l"-piece curves. If the respective points are subjected to 
a strict passage, each three-dimensional clothoid segment has 
the seven unknowns of ao, ai, a2, bo, bi, ba, and h, so that the 
unknowns total to 7(n-l) pieces. In contrast, the conditional 
expressions are as a whole 7(n-2)+3 pieces, because, every 
''n-2''-piece connecting points, there exist seven expressions 
on the coordinates, tangential line, normal line, and 
curvatures and three coordinates at an end point. Thus, the 
conditional expressions are less in number than the unknowns 
by 4. That is, this means that items to be controlled at both 
end points are 4 or more. In the following description, 
assumption is made such that m is a nonnegative integer of 4 
or more and k is a nonnegative integer of 2 or more, under which 
how to make both the conditional expressions and the unknowns 
equal in number to each other in response to inserting new points 
will now be described. 
[0197] 

(i) In the case of m=2k: 

In cases where it is required that a total of ''m=2k"-piece 
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items be controlled at both end points, the number of unknowns 
is 7{n-l) pieces in total and the number of conditional 
expressions is 7 (n-1) -4+2k pieces in total . In this situation, 
the number of excessive conditional expressions is 2k-4 pieces. 
When it is considered that ''k-2"-piece points are newly inserted, 
the number of three-dimensional clothoid segments increases by 
k-2 pieces, while the connecting points increase by k-2 pieces 
as well. As a result, the unknowns total up to 7 (n+k-3) pieces 
and the conditional expressions total up to 7 (n+k-3) -4+2k 
pieces. In the case that, of the values at the coordinates of 
each of the newly inserted points, two values (for example, x 
and y) are treated as being unknowns, the unknowns total up to 
7 {n+k-3) +2 ( k-2 ) pieces and the conditional expressions total 
up to 7 (n+k-3) +2 (k-2) pieces, permitting both the unknowns and 
the conditional expressions to be equal in number to each other. 
[0198] 

' (ii) In the case of m=2k+l: 

In cases where it is required that a total of 
''m=2k+l''-piece items be controlled at both end points, the 
number of unknowns is 7 (n-1) pieces in total and the number of 
conditional expressions is 7(n-l)+2k-3 pieces in total. In 
this situation, the number of excessive conditional expressions 
is 2k-3 pieces. When it is considered that ''k-l"-piece points 
are newly inserted, the number of three-dimensional clothoid 
segments increases by k-1 pieces, while the connecting points 
increase by k-1 pieces as well. As a result, the unknowns total 
up to 7(n+k-2) pieces and the conditional expressions total up 
to 7 (n+k-2) -3+2k pieces. In the case that, of the values at 
the coordinates of each of the newly inserted points, two values 
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(for example, x and y) are treated as being unknowns, the 
unknowns total up to 7 (n+k-2) +2 (k-2) pieces and the conditional 
expressions total up to 7 {n+k-2) +2k-3 pieces, resulting in that 
the conditional expressions are larger than the unknowns by one. 
Thus, for the case of m=2k+l, at one of the inserted points, 
only one of the values of the coordinate at the one point is 
treated as being an unknown. This countermeasure allows the 
unknowns to be 7 (n+k-2 ) +2 ( k-2 ) pieces in total and the 
conditional expressions to also be 7 (n+k-2 ) +2 ( k-2 ) pieces in 
total, whereby the unknowns and the conditional expressions are 
equal in number to each other. 
[0199] 

As stated above, in the present method, in accordance with 
the number of conditional expressions to be added, the number 
of values chosen as unknowns from the coordinates of inserted 
points can be adjusted. This makes it possible that, in various 
occasions in which parameters, such as a tangential rotation 
angle a, which are other than the tangential line, normal line 
and curvatures, are controlled, the unknowns can be equalized 
in number to the conditional expressions. In consequence, from 
a theoretical viewpoint, each value at both end points can be 
controlled. Table 4 is provided to show, as a summary, 
correspondences among the items to be controlled, the number 
of unknowns and the number of conditional expressions. 
[0200] 
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[Table 4] 

Items to be controlled at both end points, the number of unknowns, 
and the number of conditional expressions in n-point 
interpolation 



the number 

OX J- Lc^IIlo LCJ 

be 

controlled 


the number 

conditional 
expressions 
to be 
increased 


the 

points to 
be 

inserted 


the number of 

being handled as" 
unknowns per 
point 


the 
nnmbpT of 
unknowns 

to be 
increased 


4 


0 


0 


0 


0 


5 


1 


1 


1 


1 


6 


2 


1 


2 


2 


7 


3 


2 


1-piece point : 2 
1-piece point : 1 


3 


• 


2k 


2k:-4 


k-2 


''k-2''-piece 

points : 2 


2k-4 


2k+l 


2k-3 


k-1 


''k-2''-piece 

points : 2 
1-piece point : 1 


2k-3 



k: nonnegative integer of 2 or more 



[0201] 

(b) Technique: 

As shown in Figs. 17 and 18, the interpolation that uses 
a three-dimensional clothoid controlling each value at the 
starting and end points is carried out on the following 
operation flow. 

Step 1) Of the conditions to be controlled, only 4 
conditions are used to perform interpolation in which points 
being interpolated are subjected to a strict passage and the 
continuity is kept, with a curve produced on the interpolated 
results . 
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Step 2) New points are inserted into the produced curve, 
before the conditional expressions and the unknowns are 
subjected to adjustment in terms of the number thereof. 

Step 3) The curve parameters in Step 1 are used as initial 
values for obtaining approximate values of parameters of each 
curve by the Newton-Rapson method, the approximate values 
meeting the conditions to be targeted. 
[0202] 

Each Step will now be complemented as follows. First, 
at Step 1, a curve is produced by using the technique described 
in section 2-3, if the tangential direction is required to be 
controlled. Even if the tangential direction is not required 
to be controlled, initial values, which are the same as ones 
produced by the technique described in section 2-3, are used 
as initial values required for obtaining the parameters of the 
curve . 
[0203] 

Then at Step 2, new points are inserted into the curve 
for adjustment conditions and unknowns in terms of their numbers 
During this step, the number of points to be newly inserted in 
an interval between points being interpolated is required to 
be one or less, whenever possible. Further, the point to be 
inserted is at a central position of each three-dimensional 
clothoid segment produced at Step 1 and inserted to connect 
points being interpolated. Still further, the insertion of the 
points to be inserted is carried out in sequence from both ends 
of the curve. In other words, the first inserted points are 
a central point between the starting point and the adjacent 
point located next thereto and a further central point between 
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the end point and the adjacent point located next thereto. 
[0204] 

Lastly, the description will now be given to Step 3, 
v^herein it is required to decide initial values for the 
Newton-Rapson method employed in this step. For this purpose, 
the curve into which the new points have been inserted is divided 
using the technique, described in section 1-4, fro dividing the 
three-dimensional clothoid curve, and the initial values are 
decided based on respective values of the divided curves. If 
the curve will not be subjected to the insertion of any points, 
the as-produced initial values of the curve, produced in Step 
1, are used. In this way, the initial values given to the 
respective parameters of the curve in Step 3 have been decided. 
Using these initial values, the computation on the 
Newton-Rapson method is conducted to provide parameters, and 
these parameters are used to produce a three-dimensional 
clothoid curve. That is, the interpolation has been made by 
the three-dimensional clothoid curve that fulfills the targeted 
conditions in each interval between points. 
[0205] 

(c) Example of interpolation: 

An actual example of the three-dimensional clothoid 
interpolation will now be given by Table 5, in which conditions 
are listed as to tangential lines, normal lines, and curvatures 
at both ends so that control should be conducted to meet those 
conditions. The sequential numbers are given to the points 
being interpolated which are to be subject to a strict passage 
of the line, so that the points Pi, P2 and P3 are denoted. 
[0206] 
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[Table 5] 



Conditions for respective points being interpolated and 
starting and end points 





coordinate 


unit tangential vector 


principal normal vector 


curvature 


Pi 


(0,0,0) 


(Cos(e) ,Sin(0) ,0 ) 


(-Sin (9) , Cos (9) , 0 ) 


0.2 


P2 


(4,-4,-4) 








P3 


(8,-4,-5) 


(1,0,0) 


(0,-1,0) 


0.2 



* 0=-(^/6) 



[0207] 

Under the conditions listed above, the interpolation was 
conducted actually, which resulted in the figure shown in Fig. 
19. A solid-line curve represents a three-dimensional 
clothoid curve, while curves depicted by broken lines, dashed 
lines, chain double-dashed lines, and chain triple-dashed lines 
represent patterns of changes in the curvature radius of each 
curve. Fig. 20 shows a graph representing the relationship 
between the distance moved from the starting point of each curve 
and its curvature, the graph being shown depending on the types 
of lines shown in Fig. 19. As understood from Table 6, the 
produced curves meet the given conditions. 
[0208] 
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[Table 6] 



Differences between given values and produced values as 
to tangential lines, normal lines, and curvatures at starting 
and end points of each produced curve 





coordinate 


unit tangential 
vector 


principal normal 
vector 


curvatu 
re 


Pi 


given value 


{0.0, 0.0, 0.0} 


(0.8660, -0.5, 0.0} 


(0.5,0.8660,0.0} 


0.20 


value on 
produced 
curve 


{0.0, 0.0, 0.0} 


(0.8660, -0.5, 0.0} 


(0.5000, 0.8660, 0.0} 


0.20 


difference 


{0.0, 0.0, 0.0} 


{0.0, 0.0, 0.0} 


{0.0, 0.0, 0.0} 


0 


P3 


given value 


{8.0, -4.0, -5.0} 


{1.0, 0.0, 0.0} 


{0.0, -1.0, 0.0} 


0.20 


value on 
produced 
curve 


{8.0, -4.0, -5,0} 


(1.0, 0.0 ,0.0} 


{0.0, -1.0, 0.0} 


0.20 


difference 


{0.0, 0.0, 0.0} 


(0.0, 0.0, 0-0} 


(0.0, 0.0, 0.0} 


0 



[0209] 

(d) Control of value at central point: 

The technique described in item (d) has enabled both the 
control of each value at both end points and the G^-continuous 
interpolation. In the next place, the control of values at each 
central point, not both end points, will now be described. 

[0210] 

For example, for interpolating a row of points shown in 
Fig. 21, an assumption is made such that both a tangential line 
and a normal line are controlled at a central point Pc. It should 
be noted that the technique described so far will not be 
available to the control of values at central points, A 
solution to this difficulty is to divide the row of points into 
two ones so that the control can be effective. 
[0211] 
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Specifically, the interpolation should be done on 
individual divided curves Ci and C2 with a central point Pc 
therebetween, without interpolating the whole row of points at 
once. In such a case, the central point Pc is to be located 
at an end of each divided curve, with the result that the 
technique described in item (b) can be used for the control. 
[0212] 

Therefore, as described above, a curve division is done 
at a point that represents values to be controlled, the control 
for interpolation is applied to values at both ends of the 
divided curve, and the resultant curves are connected to each 
other. This way theoretically enables the three-dimensional 
clothoid interpolation which controls the tangential line, 
normal line, and curvature at each point. 
[0213] 

(2-5) Three-dimensional clothoid interpolation 

controlling tangential line, normal line, and curvature at both 
ends : 
[0214] 

(a) Flow of technique: 

An interpolation technique using the three-dimensional 
clothoid to control each value at staring and end points is 
performed by a procedure flow shown in Fig. 22, which is as 
follows. In the following, the description will be given along 
such a flow. 
[0215] 

(b-1) Giving points being interpolated: 
In an example in this section, three points {0.0, 0.0, 
0.0}, {5.0, 5.0, 10.0}, {10.0, 10.0, 5.0} were designed in the 
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three-dimensional space. The other conditions, such as 
tangential liens, normal lines, and curvatures given to each 
point, are summarized in Table 7. 
[0216] 
[Table 7] 

Points being interpolated and 



conditions for parameters at starting and end points: 





coordinate 


unit tangential 
vector 


principal 
normal vector 


curvature 


Pi 


(0.0, 0.0, 0.0) 


{0.0, 1.0, 0.0} 


{1.0, 0.0, 0.0} 


0.1 


P2 


{5.0, 5.0, 10.0) 








P3 


(10.0, 10.0, 5.0) 


{1.0, 0.0, 0.0} 


{0.0, -1.0, 0.0} 


0.1 



[0217] 

(b-2) Production of 3D DCS of r=4 : 

The Newton-Rapson method needs to have adequate initial 
values to start the search for a solution. The preparation for 
obtaining the initial values will now be performed . 3D Discrete 
Clothoid Splines, which is a preceding study to the present 
study according to the present application, is characterized 
in that points being interpolated is subjected to a strict 
passage and the curvature smoothly changes with changes in the 
distance moved from a starting point. Hence, in the present 
study, a polygon Q on 3D Discrete Clothoid Splines of r=4 is 
produced as shown in Fig. 23, and this polygon is used to compute 
and decide initial values for the three-dimensional clothoid 
interpolation. This polygon was actually produced from a row 
of points, which is shown in Fig. 24. The coordinates of the 
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apexes of the produced polygon are listed in Table 8. 

[0218] 

[Table 8] 



Coordinates of apexes of produced polygon 
coordinates of apexes 





coordinates of apexes 


Pi 


{0.0, 0.0, 0.0} 




{0.4677, 0.4677, 3.1228} 




{0.9354, 0.9354, 6.2456} 




{2.3029, 2.3029, 9.4966} 


P2 


{5.0, 5.0, 10.0} 




{6.7095, 6.7095, 9.9244} 




{8.0655, 8.0655, 8.4732} 




{9.0327, 9.0327, 6.7366} 


P3 


{10.0, 10.0, 5.0} 



[0219] 

(b-3) Decision of initial values: 

Obtaining a solution on the Newton-Rapson method involves 
decision of initial values of respective unknowns. According 
to the present technique, the polygon Q produced in section b-2 
is used to obtain approximate values of the respective unknowns, 
and those approximate values are subjected to the decision of 
the initial values. In the case of handling 3D Discrete 
Clothoid Splines, the f renet frame of each apex has already been 
acquired. Parameters ao and bo are thus obtained from the unit 
tangential vector t of the polygon Q produced in section b-2. 
This tangential vector t has already been known since the 
polygon Q was obtained, so that both this vector t and the 
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expression for a tangential line of a three-dimensional 
clothoid curve are used to compute tangential rotation angles 
a and (3. These angles allow the initial values of the parameters 
ao and bo of each curve to be decided. In addition, for a 
three-dimensional clothoid segment starting from a starting 
point, those angles provide initial values of the parameters. 
[0220] 

[Numeral 59] 



u = s 



cos fi cos a 
sin p cos a 
— sin a 



[0221] 

When it is taken into account that 3D Discrete Clothoid 
Splines provide apexes poisoning at equal distances, it can be 
approximated that the curve length variable S at a point q4i+i 
in Fig. 23 is 1/4. Similarly to this, it can be approximated 
that the curve length variable S at a point q4{i+i)-i is 3/4. In 
consideration of both the approximated variables and the 
expression concerning a of the three-dimensional clothoid curve, 
the following expression is realized. 
[0222] 

[Numeral 60] 



1 . 

a04i+-al4i + 



4j 



3 [3 
a04i+-al4i+l - 



^2 



a24i = a04i^i 
a24i = aO 



4(i+l)-l 



Since this expression is a two-dimensional simultaneous 
equation to which unknowns are al4i and a24i, this equation is 
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solved to obtain the initial values of the parameters ai and 
a2. Similarly to this, the initial values of the parameters 
bi and bz can be decided. 
[0223] 

The remaining unknown is a curve length h, of which initial 
value is calculated by solving the expression defining the 
curvature of the three-dimensional clothoid curve. The 
curvature of the three-dimensional clothoid curve can be 
expressed by the following. 
[Numeral 61] 



K = — 

h 

[0224] 

This expression can be developed into the following, on 
which the initial value of h is decided. 
[Numeral 62] 



V(al4i + 2a24i f + (bl4i + 2\) 2^; f cos^ (a04i + al4i + 2^2^-^ ) 
h4i = — - 

^^4(1 + 1) 

[0225] 

As described, the initial values of the seven 
three-dimensional clothoid parameters can be decided. 
[0226] 

The initial values actually obtained on the foregoing 
technique are listed in Table 9. 
[Table 9] 
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Initial values 



curve 

connecting 
points Pi 
and P2 


<3o 


0.0 (known) 




-0.2684 




1. 0739 


bo 


7i/2 (known) 




0.0 






0 . 0 




h 


12.7684 






-0. 1648 


curve 

connecting 
points P2 
and P3 




3.2061 




-2. 6327 


bo 


0.7853 


bi 


0.0 


b2 


0.0 




h 


9. 6752 



[0227] 

(b-4) Three-dimensional interpolation with strict 
passage through respective points and continuity: 

The initial values decided in section (b-3) are used to 
obtain approximate values of parameters of each curve by using 
the Newton-Rapson method, under the condition that the G 
continuity is kept. Using the resultant parameters, 
three-dimensional clothoid segments are produced, and then each 
span between points in a row of points is interpolated with the 
three-dimensional clothoid curve. 
[0228] 

In this three-dimensional interpolation for three points. 
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practical conditions satisfying a strict passage through points 
being interpolated and the continuity will now be described. 
Fig. 25 shows the three-dimensional clothoid interpolation for 
points Pi, P2 and P3. A curve connecting the points Pi and P2 
is denoted by a curve Ci and a curve connecting points P2 and 
P3 is denoted by a curve C2- Since aOi and bOi are already known, 
the unknowns totals up to 12 pieces consisting of parameters 
all, a2i, bli, b2i and hi of the curve Ci and parameters a02, al2/ 
a22/ b02, bl2, b22 and h2 of the curve C2. The subscripts to 
characters, which will appear hereinafter, are assigned to 
correspond to the subscripts to respective curves, in which the 
coordinates, tangential rotation angles a and p, normal line 
and curvature of each curve are expressed respectively by Pxi, 
Pyi, Pzi, ai. Pi, ni and Ki, which are functions of the curve length 
variable S. 
[0229] 

First of all, from the definition of the 
three-dimensional clothoid curve, the condition that the strict 
passage through points being interpolated should be kept at the 
point Pi is inevitably achieved whenever the starting point is 
given- A tangential direction at the point Pi is also given 
as a known value, so that no particular specif i*cation for the 
continuity is needed at the point Pi- 
[0230] 

The next to be considered is the point P2 . This point 
P2 is a connecting point to connect the curves with each other, 
so that the continuity requires that the position, tangential 
line, normal line, and curvature should be continuous thereat. 
That is, the conditions which should be realized at the point 
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P2 are as follows. 

[0231] 

[Numeral 63] 
PX,(1)= PX2(0) 

Pyi(i) = Py2(0) 

PZ,(1) = PZ2(0) 

cos[ a,(l)-c^2(0)] = 1 

COS[ /?i(l)-y^2(0)] = 1 

ni(l)-n2(0) = l 

>^l(l) = /^2(0) 
[0232] 

Lastly, the consideration is given to the point P3. This 
point P3 is an end point. This means that the necessary 
conditions to be met are abut only the position and tangential 
line, so that the following five conditions are realized, in 
which tta and P3 are tangential rotation angles a and p to decide 
a tangential vector at the end point to be given. 
[0233] 

[Numeral 64] 
PXi(l) = PX2(0) 

Pyi(i) = Py2(0) 

PZ,(1) = PZ2(0) 

cos[ - 0^2(0)] = 1 

cos[ /?i(l)->^2(0)] = 1 
n,(l)-n2(0) = 1 

[0234] 
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Hence, it can be understood that, as for the twelve 
unknowns ali, a2i, bli, b2i, hi, a02, al2, a22, bOa, bl2, b22 and 
h2, the twelve conditional expressions are provided as follows. 
These expressions can thus be summarized in a list form in the 
following . 
[0235] 

[Numeral 65] 
PXi(l) = PX2(0) 

Pyi(i) = Py2(0) 

PZi(l)=PZ2(0) 

cos[ai(l)-a2(0)] = 1 

COS[/?i(l)-;^2(0)] =1 

ni •n2 = 1 
/r,(l) = ^2(0) 

PX2(1) = PX3 

Py2(i) = Py3 

PZ2(1) = PZ3 
COS[ «2(1) - <^3] = 1 
COS[ y^2(l)-/?3] = l 
[0236] 

As described, the twelve expressions are realized for the 
twelve unknown, so that solutions to the unknowns can be found. 
The Newton-Rapson method is applied to these expressions for 
solutions, which are listed in Table 10, together with the 
initial values. 
[0237] 



92 

[Table 10] 

Initial values and solutions 







initial value 


solution 




«2o 


0.0 

( known) 




curve Ci 




-0.2684 


-5. 4455 


connecting 




1. 0739 


5. 4122 


points Pi 


bo 


n/2 (known) 




and P2 


bi 


0.0 


-3.8590 




b2 


0.0 


3. 1003 




h 


12.7684 


13. 5862 






-0 . 1648 


-0. 0332 
58 


curve C2 


ax 


3.2061 


3. 6770 


connecting 




-2. 6327 


-3. 6437 


points P2 


bo 


0.7853 


0. 8120 


and P3 


bx 


0.0 


1. 6006 




b2 


0.0 


-2. 4126 




h 


9.6752 


9.2873 



[0238] 

(b-5) Production of curve; 

Fig. 26 shows, in a parallel form, both a curve produced 
based on the parameters obtained in section (b-4) and the 
polygon produced in section (b-2) . The solid curve line denotes 
the curve Ci and the broken curved line denotes the curve C2- 
At this stage, there are provided as three-dimensional clothoid 
curves with tangential directions controlled at the stating and 
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end points and the continuity kept. 
[0239] 

(b-6) Conditional expressions and unknowns: 
Now assume that the normal lines and curvatures at the 
starting point Pi and end point P2 are given by values shown 
in Table 7. In order that the normal lines and curvatures are 
further controlled at the starting and end points, it is 
necessary to increase the number of conditions at each of the 
starting and end points by two. However, in a state where the 
number of conditions is increased by 4 , it is impossible to 
obtain a solution meeting the conditions, due to imbalance in 
number between the unknowns and the conditions. Therefore, to 
make the unknowns and conditions equal in their numbers, a new 
point DPi is inserted into the curve Ci at a point of the curve 
length variable S=0 . 5 thereon, as shown in Fig . 27. In addition, 
as to the curve C2, a new point DP2 is inserted thereinto at 
a point of the curve length variable S=0.5 thereon. 
[0240] 

In this situation, a curve connecting the points Pi and 
DPi is denoted by C'l, a curve connecting the points DPi and P2 
is denoted by C'2/ a curve connecting the points P2 and DP2 is 
denoted by C'3, and a curve connecting the points DP2 and P3 is 
denoted by C'4, respectively. The characters which appear in 
the following description involve with subscripts each 
corresponding to each curve name. For example, the coordinates, 
tangential rotation angles a and P, normal line, and curvature 
of a curve C are expressed respectively by PXc, Pyc/ Pzc/ occ/ 
Pc. He and Kc which are functions of the curve length variable 
S. Furthermore, as for the coordinates, tangential rotation 
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angles a and P, normal line, and curvature at the starting and 
end points, those are expressed respectively as PXs, Pys/ Pzsr 
ocs, Ps/ Hs and Ks at the starting point, whilst those are expressed 
respectively as Pxe, Pye/ Pze/ ocg/ Pe/ He and at the end point. 
[0241] 

In the following, the conditions realized at respective 
points are listed. 
[Numeral 66] 

Point Pi: tangential line, normal line and curvature; 4 
expressions : 
cos[ac'x(0)-a^] = 1 

0^,(0) -n, =1 



Point DPi: position, tangential line, normal line and curvature ; 
7 expressions: 

Pxc.i(l) = Pxc'2(0) 

Pyc'i(i) = Pyc-2(0) 

Pzc.i(l) = Pzc-2(0) 
cos[ac-i(l)-«c'2(0)] = 1 
cos[>ffc-ia)->^C'2(0)] = l 

nc'i(l)-nc'2(0) = 1 

'^C'l(l) = ^C'2(0) 



Point Pa: position, tangential line, normal line and curvature; 
7 expressions: 
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PXc-2(l) = PXc'3(0) 

Pyc'2(i) = Pyc'3(0) 

PZc.2(l) = PZc-3(0) 

COS[ac'2(l)-^^C'3(0)] = 1 
COS[;^C'2a)->^C-3(0)] = l 

nc'2(l)-nc'3(0) = 1 



Point DP2: position, tangential line, normal line and curvature; 
7 expressions: 

PXc.3(l) = PXc-4(0) 

Pyc'3(i) = Pyc-4(0) 

PZc.3(l) = PZC4(0) 

cos[ac-3(l)-ac'4(0)] = l 

COS[pc.3(l)-Pc4(0)] = l 

nc'3(l)-nc'4(0) = 1 

KC'3 (l) = Kc'4(0) 

Point P3: position, tangential line, normal line and curvature; 
7 expressions: 

PXc.4(l) = PXe 

Pyc'4a) = Pye 

PZc.4(l) = PZe 

cos[ac>4(l) -oLq] = \ 

COS[pc'4(l)-Pe] = l 

nc'4(l)-ne =1 

Kc'4(l) = Ke 
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[0242] 

Accordingly, the total number of conditional expressions 
to be established is 32. In contrast, each curve has the seven 
clothoid parameters consisting of ao, ^ir ^2, bo, bi, b2, and h 
and the number of curves is 4, whereby the number of unknowns 
totals to 28. That is, the unknowns and the conditional 
expressions are not equal in number to each other, so that 
solutions cannot be obtained. In order to overcome this 
situation, the y and z coordinates of the newly inserted two 
points DPi and DP2 are treated as unknowns to increase the 
unknowns by 4. Since this increase allows both the unknowns 
and the conditional expressions to be 32 in number, the 
solutions can be obtained. 
[0243] 

(b-7) Decision of initial values: 

Though the Newton-Rapson method is used to compute 
solutions satisfying the conditional expressions produced in 
section (b-6) , the initial values of the unknowns are required 
to be decided so that the computation converges at a higher rate . 
As a practical measure for that, the three-dimensional curve 
produced in section (b-5) is divided at the newly inserted 
points, with the result that four three-dimensional clothoid 
curves are produced as shown in Fig. 28, and the clothoid 
parameters are given to the curves. 
[0244] 

How to divide the curve Ci into a curve C 1 and a curve 
C'2 will now be described as a curve division method. Using 
the parameters of the curve Ci, the clothoid parameters h' , a'o/ 
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a'l, a' 2/ b'o/ b'l and b'2 of the curve C 1 can be expressed by 
the following expressions, in which a reference Sd represents 
a curve length variable at the dividing point and is 0.5 in this 
example . 
[0245] 

[Numeral 67] 



a'o 


= ao 


ai 


= aiSd 






•b'o 


= bo 


bl 


= b,Sd 


b'z 




h' 


= hSd 



[0246] 

The consideration will then be given to the curve C'2 whose 
dividing point is DPi . Let us assume a curve C"i which is 
identical in size and shape to the curve Ci but is opposite in 
direction to the curve Ci. With the use of the parameters of 
the curve Ci, the clothoid parameters h", a"o/ a"i, a"2/ b"o, b"i 
and b"2 of the curve C"i can be expressed by the following 
expressions . 
[0247] 

[Numeral 68] 
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ff 



P(l) 

ao + ai + a2 + ^ 
-(ai +2a2) 

a2 

bo +b, +b2 

-(b,+2b2) 

b2 



< 




h 



[0248] 



The dividing point DPi on this curve is expressed as 
DPi=C"i (1-Sd) . When it is assumed that the curve C\ is divided 
at the point DPi, the resultant divided curves include a curve 
C"2 whose starting point is P2 is identical in size and shape 
to the curve C'2 and opposite in direction to the curve C'2. Hence 
the technique for producing the curve C'l enables the curve C"2 
to be produced. In this calculation, the curve C2 can also be 
obtained by producing a curve having the identical size and 
shape but having the opposite direction too the curve C"2 . 



As described, at the point DPi giving 0.5 to the curve 
length variable S on the three-dimensional clothoid curve Ci, 
the curve Ci can be divided into the curves C'l and C'2. Similarly 
to this, at the point DP2 giving 0 . 5 to the curve length variable 
S on the three-dimensional clothoid curve C2, the curve C2 can 
be divided into the curves C'3 and C'4 . 



The parameters of the four curves divided on the foregoing 
are listed in Table 11. These parameters of the curves are used 



[0249] 



[0250] 
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as initial parameters to the Newton-Rapson method in 
calculating solutions satisfying the conditional expressions 
established in section b-6. 
[0251] 
[Table 11] 

Parameters of curves produced by division 



curve 
C'l 


•30 


0.0 (known) 


curve 


^0 


4.9134 


ai 


-2.7227 


ai 


-0.016629 




1.3530 


a2 


1.3530 


bo 


Tz/2 (known) 


i:^ 


0.41633 


t>i 


-1.9295 


Jdi 


-0.37938 




0.7750 


bz 


0.77507 


h 


6.7931 


h 


6.7931 


O UCtJL L.X1 iv^ 

point 


{0.0, 0.0, 0.0} 


stsrtino 
point 


{1.8431, 3.0860, 4.9597} 


curve 

C'3 


ao 


-0.033258 


curve 


ao 


7.1774 




1.8385 


■31 


0.016629 


52 


-0.91093 




-0.91093 


bo 


0.81202 




1.0091 


bi 


0.80031 




-0.40601 




-0.60316 




-0.60316 


h 


4.6436 


h 


4.6436 


starting 
point 


{5.0, 5,0, 10.0} 


starting 
point 


{7.0029, 8.1298, 7.5337} 



[0252] 

(b-8) Obtaining clothoid parameters satisfying 

conditions : 

Based on the initial values decided in section (b-7) , the 
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solutions satisfying the conditional expressions established 
in section (b-6) were obtained using the Newton-Rapson method. 
Table 12 shows those calculated parameters of each curve. In 
addition. Table 13 shows differences between given values and 
the produced values in respect of the tangential line, normal 
line, and curvature at the starting and end points of each 
produced curve. 



[0253] 
[Table 12] 

Parameters of produced curves 



curve 


Bq 


0.0 (known) 


curve 


So 


5.3846 


ai 


0.0000 


<3l 


-3.4602 


•32 


-0.89854 


32 


4.341 


Jfcb 


7t/2 (known) 


bo 


0.47690 


bi 


-0.51836 


bi 


-3.2143 




-0.57552 


bi 


3.4613 


h 


5.1836 


h 


9.9808 


starting 
point 


{0.0, 0.0, 0.0} 


starting 
point 


{1.8431, 4.1726, 1.4653} 


curve 

C^3 


ao 


-0.017740 


curve 

C'4 


ao 


6.8553 




3.4572 


ai 


-1.1443 


32 


-2.8673 


32 


0.57219 


bo 


0.72385 


bo 


0.76315 


bi 


2.4551 


by 


-1.1942 


bz 


-2.4158 


bi 


^ 0.43108 


h 


6.60818 


h 


3.3206 


starting 
point 


{5.0, 5.0, 10.0} 


starting 
point 


{7.0029, 9.0734, 5.6186} 
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[0254] 
[Table 13] 

Differences between given values and produced values in respect 
of tangential line, normal line and curvature at starting and 
end points of produced curve 





coordinate 


unit tangential 
vector 


principal nontal 
vector 


curvature 




given 
value 


{0.0, 0.0, 0.0} 


{0.0, 1.0, 0.0} 


{1.0, 0.0, 0.0} 


0.10 


Pi 


value on 
produced 

curve 


{0.0, 0.0, 0.0} 


{0.0, 1.0, 0.0} 


{1.0, 0.0, 0.0} 


0.10 




difference 


{0.0, 0.0, 0.0} 


{0.0, 0.0, 0.0} 


{0.0, 0.0, 0.0} 


0 




given 
value 


{10.0, 10.0, 5.0} 


{1.0, 0.0, 0.0} 


{0.0, -1.0, 0.0} 


0.10 




value on 

produced 
curve 


{10.0, 10.0, 5.0} 


{1.0, 0.0, 0.0} 


{0.0, -1.0, 0.0} 


0.10 




difference 


{0.0, 0.0, 0.0} 


{0.0, 0.0, 0.0} 


{0.0, 0.0, 0.0} 


0 



[0255] 

(b-9) Production of curves: 

A curve produced on the parameters obtained in section 
{b-8) is shown in Fig. 29. In this figure, the solid line 
depicts a three-dimensional clothoid curve, while the broken 
line, chain line, chain double-dashed line, and chain 
triple-dashed line depict respectively patterns of changes in 
the curvature radius of each curve in which the change patterns 
are calculated on both the principal normal line which is set 
to the direction of each curve and the curvature radius which 
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is set to the size of each curve (the radius curvature is 
subjected to the logarithm computation after addition of the 
logarithm natural) . Fig. 30 shows a graph presenting the 
relationship between the distance s moved from the starting 
point of each curve and the curvature k depending on the 
respective types of the curves shown in Fig. 29. From Table 
12, it is understood that the produced curves satisfy the given 
conditions . 
[0256] 

As described, how to produce the curves on the 
three-dimensional clothoid interpolation in such a manner that 
the tangential line, normal line and curvature at both ends are 
controlled has been exemplified. 
[0257] 

3. Method of designing regression path of ball screw by 
using three-dimensional clothoid interpolation: 

As an example in which the three-dimensional clothoid 
interpolation is applied to machine design, the regression path 
of a deflector type of ball screw will now be designed. 
[0258] 

(3-1) Description of deflector type of ball screw: 
Figs. 31 to 35 show a deflector type of ball screw. This 
ball screw has a deflector serving as a regression path of balls 
rolling on a thread groove. The deflector is classified into 
a type of deflector which is formed separately from a nut and 
then fixed on the nut and a type of deflector which is formed 
together with a nut. Fig. 31 illustrates the former one, in 
which the deflector is separated from the nut at the beginning 
of the production. 
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[0259] 

Hereinafter, the type of ball screw in which the deflector 
is produced as one unit with the nut will now be described. Fig. 
32 shows a nut 1 employed by this type of ball screw in which 
the deflector is produced as one unit with the nut. The nut 
1 has an inner circumferential surface, on which a load ball 
rolling groove 2 is formed which serves as a spiral load rolling 
element rolling groove whose circumferential distance is less 
than one turn. The load ball rolling groove 2 has a lead made 
to agree with the ball rolling groove of a screw shaft described 
later. There is also provided a ball circulating groove 3, 
serving as the regression path, and connecting one end and the 
other end of the load of the load running groove and having a 
lead of which direction is opposite to that of the load ball 
rolling groove 2. The load ball rolling groove 2 and the ball 
circulating groove 3 are paired to form a single one-turn groove 
4. Fig. 33A shows a perspective view of the nut 1 in which the 
ball circulating groove 3 can be seen, while Fig. 33B shows a 
perspective view of the nut 1 in which the load ball rolling 
groove 2 can be seen instead. 
[0260] 

This nut lis combined with the screw shaft , whose combined 
state is shown in Fig. 34. 

[0261] 

The screw shaft has an outer circumferential surface, on 
which there is formed a ball rolling groove 6 serving as a spiral 
rolling element rolling groove having predetermined leads. 
The load ball rolling groove 2 of the nut 1 is opposed to the 
ball rolling groove 6 of the screw shaft 5. Between the load 
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ball rolling groove 2 and ball circulating groove 3 of the nut 
1, and the screw shaft 5 of the screw shaft 5, a plurality of 
balls are put in an array, which serve as a plurality of rolling 
elements which can move in a rolled manner. In response to 
relative rotation of the nut 1 to the screw shaft 5, the plurality 
of balls roll with load received between the load ball rolling 
groove 2 of the nut 1 and the ball rolling groove 6 of the screw 
shaft 5. 
[0252] 

The ball circulating groove 3 of the nut 1, which is shown 
in Fig. 32, is a part corresponding to the deflector shown in 
Fig. 31. The ball circulating groove 3 makes it possible that 
the balls overleap screw threads 7 of the screw shaft 5 in such 
a manner that the balls, which rolls along the load ball rolling 
groove 2 of the screw shaft 5, return to the original load ball 
rolling groove after one turn around the screw shaft 5. 
[0263] 

In the case of the conventional model, the regression path 
was formed such that, when a development elevation shown in Fig. 
35 is wound around the screw shaft, the path is seen to be shifted 
from the screw shaft center to a certain extent that the screw 
threads are avoided from colliding with the balls. As can be 
understood from curvature changes shown in Fig. 36, this path 
is discontinuous. Hence the three-dimensional clothoid 
interpolation is used to redesign a circulation path with 
continuous curvature changes. 
[0264] 

Fig. 37 shows a trajectory depicted by the center of a 
ball . In order to realize that the circulating path along which 
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a ball rolls is G2-continusou as a whole, it is required to be 
G2-continuous at a point where the ball transfers to the 
regression path. Thus, for designing a regression path, it is 
considered that the fact that a tangential line, normal line 
and curvature should be controlled at both end points of the 
regression path. 
[0265] 

(3-2) Hereinafter the three-dimensional clothoid curve 
is used to design the regression path of a deflector type of 
ball screw, and an example of this design will now be described. 
[0266] 

(a-1) Screw shaft and balls: 

The dimensions of a screw shaft and balls used in the 
present design are listed in Table 14. 
[0267] 
[Table 14] 



Dimensions of screw shaft and balls 



outer diameter of screw shaft (mm) 


28.0 


ball central diameter (mm) 


28 . 0 


root diameter (mm) 


24 . 825 


pitch (mm) 


5.6 


ball diameter (mm) 


3. 175 



[0268] 

(a-2) Symmetry and coordinate system: 

In designing the regression path of the deflector type 
of ball screw, applications of the ball screw require that the 
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regression path be axial symmetry. A coordinate system used 

in the design will now be described. 

[0269] 

First, as shown in Fig. 38, the z-axis is assigned to the 
direction of the screw shaft. A solid line in Fig. 28 shows 
a trajectory depicted by the center of a ball when the ball is 
moved along a thread groove. Assignment is made in the 
coordinate system such that a point entering a regression path 
is Ps/ a point returning from the regression path to a thread 
groove is Pe, and a middle point between both points Ps and P© 
is Pm. As shown in Fig . 39, when being projected to the xy plane, 
both points Ps and Pg create an isosceles triangle among the 
points 0, Ps and Pe, in which the y-axis is assigned to the 
direction along a perpendicular bisector passed through an 
angle ZPsOPe of this isosceles triangle. With the symmetry 
considered, the y-axis is set so as to pass the point Pm- The 
directions of the respective axes are those as shown in Figs. 
38 and 39. The coordinate system is set like this, in which 
the regression path is designed to be y-axis symmetry. 
[0270] 

In actual design, an angel 9 was set to 15 degrees in the 
above coordinate system and the coordinates of each point were 
decided based on this angle. The decided coordinates, 
tangential line, normal line and curvature are listed in Table 
15 . 

[0271] 
[Table 15] 
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[0272] 

(a-3) Constraint conditions: 

Description will now be given to constraint conditions used 
in the design of the regression path of the deflector type of ball 
screw. At first, the points Ps and Ps should have the continuity 
in respect of the curve of a trajectory depicted by the center of 
a ball rolling along the thread groove. 
[0273] 

The description will then be given to a height over which 
the ball is lifted. When talcing it account that the regression path 
is the y-axis symmetry, it is understood that the center of the 
ball passes a certain point on the y-axis. This point is noted as 
Ph (refer to Figs . 38 and 39). Thus, in order that the ball overleaps 
a screw thread, it is at least required that the absolute value 
of the y-coordinate of the point Ph satisfy a condition of 

(absolute value of y-coordinate of point Ph) > (outer diameter 
of screw shaft + ball diameter) /2. 

Thus, in the present design, setting was made such that 

(absolute value of y-coordinate of point Ph) = (outer diameter 
of screw shaft + ball diameterxl . 2) /2 . Furthermore, when taking 
the y-axis symmetry into consideration, the normal direction should 
be {0,1,0}, which results in that the tangential direction has only 
a degree of freedom to rotate therearound. 
[0274] 

The regression path with the y-axis symmetry, which still 
meets the foregoing conditions, is produced with the 
three-dimensional clothoid curve. Actually, in addition to the 
foregoing conditions, interference with the screw shaft should be 
taken into account. This interference problem is avoided by 



109 

redesigning the path through procedures where the initial values 
for the interpolation are changed and/or points being interpolated 
are increased, if an inspection of the designed regression path 
reveals such interference, 
[0275] 

(a-4) For avoiding interference: 

The interference with the thread shaft tends to occur in a 
beginning part of the regression path and such a tendency of the 
interference cannot be avoided in cases where the path is formed 
on the free interpolation. It is commanded that the regression path 
is released from the screw shaft and returned to its original 
position over the screw threads. For avoiding the interference, 
it is desirable that the path is released from the screw shaft by 
a certain amount of height, before being returned to its original 
position over the screw threads. Methods of producing such a 
regression path include a technique by which the number of points 
being interpolated is increased for avoiding the interference and 
a further technique by which the first curve located to face the 
regression path is manually produced to perform a forcible release 
from the screw shaft. Of these techniques, the present design 
adopted the technique by which the first curve located to face the 
regression path is manually produced to perform a forcible release 
from the screw shaft. 
[0276] 

Here, the first curve Ci which is located to face the 
regression path stating from the point Ps will now be described. 
With handling the coordinates, tangential rotation angles a and 
(3, normal line and curvature on the curve Ci as functions of the 
curve length variable S, these parameters are expressed as Pxr(S) , 
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Pyr(S), Pzi(S), ai(S), Pi(S), ni(S), andKi(s). In addition, as to 
the points Ps and Ph, the coordinates, tangential rotation angles 
a and P, normal line and curvature at the point Ps are expressed 
as Pxs, Pys/ Pzs/ OLsf Ps^ snd Kg, while those parameters at the 
point Ph are expressed as Px^/ PYh/ ^'^hr Ph^ . 

Conditions for realizing the G2 continuity from a trajectory curve 
depicted by the center of a ball rolling along the thread grooves 
result in that the following expressions are realized at the point 

[0277] 

[Numeral 69] 

Point Pg: tangential line, normal line and curvature: 4 

expression 

cos[ai(0)-as] = l 

cos[A(0)-A] = i 

ni(0)- 113-1 

[0278] 

In addition, a trajectory curve depicted by the center of 
the ball rolling on and along the thread grooves can be expressed 
by the three-dimensional clothoid curve. On the other hand, a 
three-dimensional clothoid curve Co which starts from a point shown 
in Fig. 4 0 and runs by one turn can be expressed by the following 
expressions, in which pit represents a screw pitch, R represents 
an outer diameter of the screw shaft, and ao represents a screw 
pitch angel. 
[0279] 

[Numeral 70] 



Ill 



ao(S) = -aQ 
>^o(S) = >^e + 2;rS 



ho = y/pit ^ + (27rR f 
Po(S) = Pe + ho {Ju(S)dS 



[0280] 

In the expressions about the curve Co, the point Ps is 
expressed as Ps=Po (11/12) . In cases where a curve having the 
parameters listed in the next expression is produced as a curve 
Ci staring from the point Ps and achieving the G2 continuity from 
the curve Co at the point Pg, the forcible release from the screw 
shaft is possible. 
[0281] 

[Numeral 71] 



2 



a, (S) = -ao 

^.(S) = . ^(blo . if b2o)s - ^(b,o . if b2o]s 

Pi(S) = Ps + 1^ jju,(S)dS 

[0282] 

For example, as such a curve Ci satisfying the above 
conditions, a three-dimensional clothoid curve with parameters 
listed in Tale 16 is produced. 
[0283] 
[Table 16] 



Parameters of curve Ci 
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J3 A 


XJ • ^ X ^ vJ 




^1 


0 0 




"2 


0 . 0 


curve Ci 


bn 


6. 0213 








i:>i 


0.10472 






-0.41887 




h 


1.4631 




Starting 
point 


{-3.6088, -13.5249, 2.5563} 



[0284] 

A comparison between the values of the tangential line, 
normal line, and curvature between the curves Co and Ci at the point 
Ps results in Table 17, from which it is confirmed that the 
continuity is realized. 
[0285] 
[Table 17] 
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[0286] 

Further, from Figs. 41 and 42, it is comprehended that this 
curve has a shape which enables a mere release from the screw shaft. 
Thus, as to the first curve Ci located to face the regression path 
starting from the point Ps, the parameters of this curve were used. 
[0287] 

(a-5) Conditional expressions for three-dimensional 
clothoid interpolation and unknowns: 

In consideration of the conditions stated in section a-3, 
the Newton-Rapson method is used to obtain approximate values of 
the parameters of each curve under the condition that the 
continuation is realized. Since the curve Ci starting from the 
point Ps has already been produced in the description done so far, 
how to design a path connecting the end point Pi of the curve Ci 
and the point Ph will then be descried. Subscripts being used in 
the following description have correspondences between each 
character and each curve, so that the coordinates, tangential 
rotation angles a and P, normal line, and curvature of and to each 
curve are expressed, as functions of the curve length variable S, 
by Pxi'(S), Pyi'(S), PZi(S), ai(S), pi(S), ni(.S), and Ki(S). In 
addition, at the point Ph, the coordinates, tangential rotation 
angles a and p, normal line, and curvature of and to each curve 
are expressed by Pxn, Pyh^ PZh/ cxh/ Ph^ nh, and hh. 
[0288] 

In the design of the path, the points which should be 
subjected to a strict passage are the two points Pi and P2/ so that 
the three-dimensional interpolation is directed to those two points. 
Considering interpolating conditions required at both end points 
teaches the fact that the conditional expressions are larger in 
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number than the unknowns by 2. Hence, for the G^-continuous 
three-dimensional clothoid interpolation, let us assume that a 
point P2 is inserted between the points Pi and Ph, as illustrated 
in Fig. 43. In addition, let a curve connecting the points Pi and 
P2 be a curve C2 and a curve connecting the points P2 and Pg be a 
curve C3, respectively. 
[0289] 

[Numeral 72] The following is interpolation condition at each 
point. 

Point Pi: tangential line, normal line, and curvature : 4 expressions 

COS[ ^2(0)- ai(l)] = 1 
COS[ /?2(0)- = 1 

n2(0)-ni(l) = 1 

Point Pg: position, tangential line, noarmal line, and curvature: 
7 expressions 

PX3(1)= PX2(0) 

Py3a) = Py2(0) 

PZ3(1) = PZ2(0) 
COS[C^3(l)-a2(0)] = 1 
COS[ >53(1)-/?2(0)] = 1 

n3(l)-n2(0) = l 



Point Ph: position, p, and normal line: 5 expressions 
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PX 3(1) = PX h 

Py 3(1) = Py h 

PZ 3(1) = PZ h 
COS[ ^3(1)] = 1 
113(1) .{0,1,0} = 1 

[0290] 

As listed above, the number of conditional expressions to 
be established is 16 in total- The clothoid parameters owned by 
each curve is seven pieces consisting of ao, ai, a2r bo, bi, b2 and 
h, and the number of unknowns is 14, because the number of curves 
is two. However, the unknowns are not equal in number to the 
conditional expressions, so that solutions cannot be obtained. 
Therefore, the y and z coordinates at the newly inserted two points 
P2 are treated as unknowns so as to increase the unknowns by 2 . By 
this increase, the unknowns and the conditional expressions are 
both 16 in number, respectively, whereby solutions can be obtained. 
Though not being reduced into practice in the present design, this 
relationship between the number of unknowns and the number of 
conditional expressions is always met whenever a point to be passed 
strictly in mid course is given and the G2 continuity is realized 
before and after the given point. Thus solutions can be calculated 
even if points being interpolated are increased between the points 
Pi and Ph. 
[0291] 

(a-6) Obtaining clothoid parameters satisfying conditions: 
Solutions satisfying . the conditional expressions 
established in section a-5 were calculated by using the 
Newton-Rapson method. How to interpolate parameters and how to 
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produce initial values were based on the techniques for the 
three-dimensional clothoid interpolation. Table 18 shows the 
calculated parameters of each curve and Table 19 shows shifts in 
the coordinate, tangential line, normal lines and curvature at each 
connecting point . 



[0292] 
[Table 18] 

Produced parameters of curve 



curve C2 


ao 


-0 . 063576 


ai 


0. 0000 




0.62696 




-0.57595 




-0. 98004 




0 77 Q1 ^ 


h 


1. 9561 


starting 
point Pi 


{-2.2429, -14.021, 2.6492} 


curve C3 


ao 


6. 8465 


ai 


1.729 


a2 


-0.86450 


bo 


-0.77684 


bi 


0.79736 


bz 


-0.020523 


h 


2.69723 


starting 
point P2 


{-0.93007, -15.389, 2.3720} 



[0293] 
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[0294] 

(a-7) Production of path: 

On the basis of the parameters obtained in sections a-5 and 
a-6, the path extending from the point Ps to the point Ph can be 
designed. Additionally, the path extending from the point Pn to 
the point Pg can also be produced with use of the same curve, because 
both paths are y-axis symmetry. That is, the same path is provided 
by re-setting the. coordinate system so as to regard the point Pe 
as the point Ps. 
[0295] 

Fig. 44 shows a path produced on the foregoing techniques. 
In the figure, a solid line depicts a curve Co which is a trajectory 
presented by the center of a ball on the screw shaft, and a broken 
line, a chain line, and a chain double-dashed line depict three 
curves Ci, C2 and C3, respectively, which form the path extending 
from the point Ps to the point Pn- In addition, the three curves, 
which are depicted by the chain double-dashed line, chain line, 
and dashed line and which serve as a connection between the points 
Pn and Pe^ are curves which are symmetric to the curves C3, C2 and 
Ci with regard to the y-axis. 
[0296] 

Fig. 45 presents a graph showing the relationship a moved 
distance s and the curvature k, wherein the moved distance is 
obtained by moving along the regression path counterclockwise when 
it is viewed in the positive z-axis direction from the point P©. 
The types of lines in the graph correspond to those of the curves 
in Fig. 44. 
[0297] 

Based on the above technique, the regression path of the 
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deflector type of ball screw was designed by the three-dimensional 
clothoid curve. This technique for designing the regression path, 
which uses the three-dimensional clothoid curve, will not be 
limited to the application to the deflector type of ball screw, 
off course. Other applications are possible, which include an 
application to a ball screw, called a return pipe type of ball screw, 
in which the regression path is composed of a pipe, and a further 
application to a ball screw, called an end cap type of ball screw, 
in which balls are picked up from the ball rolling groove of a screw 
shaft by an end cap placed on a nut end surface and the balls are 
returned to the ball rolling groove from an opposite-side end cap 
after being passed through the inside of the nut. 
[0298] 

By the way, in cases where programs for achieving the design 
method according to the present invention are performed by a 
computer, the programs are previously stored in auxiliary storages, 
such as hard disk units, of the computer, and then loaded into a 
main memory thereof. In addition, such programs may be stored in 
portable recording mediums such as CD-ROMs for making sales, or 
may be stored in a recording medium of a computer connected to a 
network so that the programs may be transferred to other computers 
via the network. 
[0299] 

B. Numerical control method using the clothoid curve: 
Hereinafter, as for embodiments of the present invention 
according to the numerical control method using the clothoid curve, 
the description will now be given, by turns, to each of divided 
items consisting of 1) definition and characteristics of a 
three-dimensional clothoid curve, 2) interpolation method based 
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on the three-dimensional clothoid curve, and 3) numerical control 
method using the three-dimensional clothoid curve. 
[0300] 

1. Definition and characteristics of a three-dimensional 
clothoid curve: 
[0301] 

(1) Basic expression of the three-dimensional clothoid: 
A clothoid curve (Clothoid curve) , which is also called 
Cornu' s spiral, is a curve whose curvature changes in proportion 
to the length of the curve. The conventionally known 
two-dimensional clothoid curve is one kind of planar curves 
(two-dimensional curves) and expressed in the xy coordinate system 
shown in Fig. 4 6 by the following expressions. 
[0302] 

[Numeral 73] 

P = Po + j%-j^ds = Po+hJ^^ej^dS, 0<s<h, 0<S = ^<1 

(1) 

^ = Co +C1S + C2S =(f)Q +^yS + ^zJuS (2) 

wherein 
[Numeral 74] 

P = x + jy, j = V^ (3) 

is a positional vector representing a point on the curve and 
[Numeral 75] 

Po=xo+jyo (4) 



122 

is an initial value (a positional vector at a starting point) of 
the positional vector. 
[Numeral 7 6] 

= cos(p + jsin^^ (5) 

is a unit vector (a vector of which length is 1) representing a 
tangential direction on the curve and the direction ^ is measured 
in the counterclockwise direction from an original line (x-axis 
direction) . Multiplying this unit vector by a infinitesimal length 
ds for integration of the multiplied results leads to acquisition 
of a point P on the curve. 
[0303] 

Let us assume that a length on the curve, which is measured 
along the curve from a starting point thereof, is s and a whole 
length (a length from the starting point to an end point of the 
curve) is h. A value obtained by dividing s by h is expressed as 
S . S is a dimensionless value, which is referred to as a curve length 
variable . 
[0304] 

As shown in Expression (2) , the clothoid curve has a feature 
that the tangential direction angle ^ is expressed as a quadratic 
expression of the curve length s or the curve length variable S. 
Co, ci, and C2 or ^or and (|)v are coefficients of the quadratic 
expression, and these coefficients and the whole length h of the 
curve are called clothoid parameters. Fig. 4 7 shows the shape of 
a general clothoid curve. 
[0305] 

The above relationships are expanded to the 
three-dimensional one to produce expressions representing a 
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three-dimensional clothoid curve- Conventionally, expressions 
which provide the three-dimensional clothoid curve have not been 
known. This time, however, the present inventors have completed 
this expansion for the first time in this field. 
[0306] 

The three-dimensional clothoid curve is defined by the 
following expressions. 
[Numeral 77] 



P = Po + J^'uds = Po+hJ^^udS, 0<s<h, 0<S = ^<1 

(6) 
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(7) 

a-2iQ +aiS + a2S (s) 

y^ = bo+biS + b2S2 (9) 

wherein 
[Numeral 78] 
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P = 



X 






' y 




yo ' 


z 




^0. 



(10) 



denotes a positional vector at each point on the three-dimensional 
clothoid and an initial value of the positional vector, 
respectively, i, j and k are unit vectors in the x-axis, y-axis 
and z-axis directions, respectively, 
[0307] 

u is a unit vector representing the tangential direction at 
the point P on the curve, which is given by Expression (7) . In 
Expression (7) , E^*^ and E^*^ show rotation matrices and, as shown in 
Fig. 48, mean a rotation of angle (3 about the k-axis (z-axis) and 
a rotation of angle a about the j-axis (y-axis) , respectively. The 
former is called a yaw ro.tation, while the latter is called a pitch 
rotation. Expression (7) thus means that rotating the unit vector 
in the i-axis (x-axis) direction by an angle a about the j-axis 
(y-axis) and then rotating the resultant unit vector by an angle 
P about the k-axis (z-axis) produces the tangential vector u. 
[0308] 

In other words, in the case of the two-dimension, a unit 
vector e^* representing a tangential direction on a curve is obtained 
on a tilt angle (j) made from the x-axis. In the case of the 
three-dimension, the tangential vector u on a curve can be obtained 
on the pitch angle a and the yaw angle p. A pitch angle of 0 provides 
a two-dimensional clothoid curve wound in the xy plane, while a 
yaw angle of 0 provides a two-dimensional clothoid curve wound in 
the xz plane. Multiplying the tangential vector u by a 
infinitesimal length ds for integration provides a 
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three-dimensional clothoid curve - 
[0309] 

For the three-dimensional clothoid curve, the tangential 
vector has a pitch angle a and a yaw angle p which are given by 
a quadratic expression of the curve length variable S, as shown 
by Expressions (8) and (9), respectively. This enables free 
selection of changes of the tangential direction, while still 
giving continuousness to the changes. 
[0310] 

As represented by the above expressions, the 
three-dimensional clothoid curve is defined as ''a curve in which 
the pitch angle and the yaw angle of a tangential direction are 
expressed by a quadratic expression of a curve length variable, 
respectively. 
[0311] 

A single three-dimensional clothoid segment starting from 
Po is decided with seven parameters composed of 
[Numeral 7 9] 

a^, a^, a^, b^, b^.b^, h (H) . 

The six variables of ao to hz have the unit of angle and represent 
the shape of a clothoid segment. In contrast, h has the unit of 
length, which represents the amplitude of a clothoid segment. 
[0312] 

A typical example of the three-dimensional clothoid curve 
is a spiral curve, as shown in Fig. 49. 
[0313] 

(2) Moving frame: 

Replacing the basic tangential vector i with basic coordinate 
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system [i, j, k] in Expression (7) provides amoving frame E, which 

is expressed as follows. 

[0314] 

[Numeral 80] 

E = [u V w] = Ei^^Ej^ [i j k] = eI^^EJ^ [i] = e'^^EJ^ 
cos (5 cos a — sin (3 cos [i sin a 

sin/?cos<3: cosy^ siny^sincir (12) 
- sin a 0 cos a 





COS J3 COS a 




- sin 13 




COS y5 sin a 


u = < 


sin /3cosa 




cos J3 




sin sin a > 




-sin a 




0 




cos a 



(13) 



In these expressions, v and w are unit vectors contained in a plane 
perpendicular to a tangential line on a curve and these unit vectors 
are perpendicular to each other and also perpendicular to a 
tangential unit vector u. A group of these three unit vectors 
(triad) is a frame (coordinate system, frame) which moves together 
with a moving point P, so that the group of the three unit vectors 
is referred to as a moving frame. 
[0315] 

Because the moving frame can be provided by the foregoing 
expressions, the computation of the principal and binormal lines 
is facilitated, thereby curves can easily be analyzed in terms of 
their shapes. 
[0316] 

Further, the moving frame E can be used to obtain the 
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attitudes of tool points of a robot, which makes it possible to 
provide the positional attitudes of an object griped by a robot 
hand. 
[0317] 

When assuming that the start and end values of the moving 
frame E are indicated by Eq and Ei, respectively, the following is 
provided . 
[Numeral 81] 

Eo = E^^'E^^' (14) 

£^ ^£k(bo+bi-fb2)£j(ao+aiH-a2) ^^^^ 
[0318] 

(3) Rolling: 

With talcing the moving frame into consideration, the third 
rotation ''roll'' can be handled. The roll is a rotation around a 
tangential direction. Though the roll has no influence on the shape 
of the three-dimensional clothoid itself, the roll influences a 
moving frame induced from the three-dimensional clothoid. For 
example, abacus balls through which a piece of winding wire is passed 
can be rotated freely on the wire, but this does not mean that the 
shape of the wire is changed by the rotation. 
[0319] 

In consideration of the rolling, the moving frame can be 
expressed as follows. 
[Numeral 82] 

E = E^^EJ^E^^I = E^^EJ^E^^ as) 

[0320] 
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A rolling angle y in this expression can be represented as 
a function of S. 
[Numeral 83] 

,2 



y = cq + CjS + C2S^ 

[0321] 



(17) 



(4) Geometrical characteristics of the three-dimensional 
clothoid curve: 
[0322] 

(a) Normal line to the three-dimensional clothoid curve: 
It is known that a normal vector to a three-dimensional curve 

can be provided by the following expression, which uses a tangential 

vector u. 

[0323] 

[Numeral 84] 
,f 



U 



n = 



u 



• (18) 



[0324] 

Using Expression (7), the first-order derivative of a 
tangential vector to a three-dimensional clothoid curve can be 
obtained by the following. 
[Numeral 85] 



u'(S) = 



a' (S) cos j3iS) sin a(S)+ (S) sin ^^(S) cos a(S) 
a' (S) sin ;^(S) sin a{S)+ J3' (S) cos /?(S) cos a(S) 
-a'(S)cosa(S) 



||u'(S)|| = ^la'iSf+j3\Sf cos^ a(S) 
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(19) 

[0325] 

That is, by using S, the nornal vector to the 
three-dimensional clothoid curve can be represented as follows. 
[Numeral 86] 



n(S) = 



u'(S) 

^•(S)| 



ylaXSf-\-/yiSfcos^a(S) 



- a' (S) cos^(S) si aa(S) - /?' (S) sin/?(S) cosa(S) 
-a'(S)sinAS)sina(S) + /?'(S)cosAS)cosa(S) 
-<2:'(S)cosa(S) 



(20) 

[0326] 

(b) Normal line to the three-dimensional curve, with the 
use of rotation: 

In this item, it will now be considered about how to decide 
a normal line u, in the similar way to deciding the tangential line 
n shown in Expression (7) . Assume that, with an initial tangential 
direction (1, 0, 0) given, the constant y is used to express the 
initial normal direction as (0, cosy, -siny) . Rotation this 
direction in the same way as that of the tangential line, the normal 
line n is expressed as follows. 
[0327] 

[Numeral 87] 



130 



n(S) = 



cosa(S) 0 sina(S) 

0 1 0 
-sina(S) 0 coscir(S) 



cosy^(S) -sin AS) 0 
sin/?(S) cosy^(S) 0 

0 0 1 

'- sin 7 cos >9(S) sin a(S) - cos y sin /?(S) 

- sin 7 sin ;^(S) sin a(S) + cos y cos >^(S) 

-sin7Cosa(S) 



0 

cos 7 

-sin 7 



(21) 



[0328] 

A comparison between Expressions (20) and (21) reveals that 
siny and cosy correspond to Expressions listed below. 
[Numeral 88] 



Sin 7 = 



cosy = 



yg^(S)cosa(S) 



(22) 



[0329] 

(c) Continuity of normal line at connecting point in the 
three-dimensional clothoid interpolation: 

In order to assure that normal lines are continuous at a 
connecting point in the step of carrying out the three-dimensional 
clothoid interpolation, it is understood from Expression (22) that 
it is sufficient to satisfy that values provided by an expression 
of 

[Numeral 89] 

«'(S) 



tan 7 



j3'iS)cosa(S) 



(23) 
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are continuous. 
[0330] 

(d) Curvature of the three-dimensional clothoid curve: 
The curvature of a three-dimensional clothoid curve is 

provided by the following expression. 

[Numeral 90] 

II P'(S)xP"(S)|| II u(S)xu'(S)|| _ || u'(S)|| 

[0331] 

From Expression (19) , the curvature is expressed as follows. 
[Numeral 91] 



^(S) = ^ ^ (25) 

[0332] 

(5) Characteristics of the three-dimensional clothoid 

curve : 
[0333] 

(a) Continuity of the curve: 

In the case of a single clothoid segment (i.e., a clothoid 
represented by the same parameters), pitch angles and yaw angles 
made by its tangential directions are given by quadratic 
expressions with a curve length variable S, respectively. Thus it 
is guaranteed that normal directions obtained by applying one-time 
differential to the quadratic expressions and curvatures to be 
obtained by two-time differential to that are continuous with the 
respect to the curve length variable S. In other words, each one 
clothoid has normal lines and curvatures, which change continuously 
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along the one clothoid curve. Accordingly a smooth and good quality 
curve can be obtained. In the case that two clothoid curves are 
mutually connected, it is sufficient to select parameters to permit 
tangential lines, normal lines, and curvatures to be continuous 
at their connecting point. This selection manner will produce a 
one smoothly connected line, called clothoid splines. 
[0334] 

(b) Applicability: 

Because the tangential directions of curves can be swung with 
changing two angles (pitch angle and yaw angle) , an arbitrary 
three-dimensional curve can be produced in conformity with various 
conditions for various applications . 
[0335] 

(c) Geometric curves and consistency: 

Geometric curves, such as liner segments, circular arches, 
and screw curves, can be produced by giving zero to some of the 
clothoid parameters or giving particular functional relationships 
to some of the parameters . The curves to be produced in those ways 
are a kind of clothoid curves, so that they can be expressed in 
the format of clothoids. Accordingly, it is not necessary to treat 
the curves, as done in the conventional NC, by changing the formats 
on which liner segments, circular arches, free curves, and others 
are described. The curves can be computed or controlled without 
changing the formats thereof. 
[0336] 

Furthermore, by replacing either a or p at any time, a 
two-dimensional clothoid can be made. Thus, sources of knowledge 
which have already been acquired concerning the two-dimensional 
clothoid can be utilized well. 



133 



[0337] 

That is, proper setting of a or P makes it possible to express 
individual curves, such as circular arches and liner segments, 
including the already known two-dimensional clothoid. Such 
respective curves can be expressed by using the expressions having 
the same format as that for expressing the thee-dimensional 
clothoid curve, thereby simplifying the computation procedures. 
[0338] 

(d) Good perspective: 

In mathematizing free curves using the conventional 
interpolation techniques including the spline interpolation, it 
is frequent that the whole shape or a local shape is difficult to 
understand. In contrast, for using the three-dimensional clothoid, 
it is possible to imagine each of a pitch angle and a yaw angle, 
with the result that the whole shape can be grasped in a relatively 
easier manner. 
[0339] 

In addition, on completion of expressing a curve as a clothoid 
curve, the line lengths, tangential directions, curvatures thereof 
have been known. Thus, unlike the conventional interpolation 
techniques, there is no need for new computation. Namely, 
correspondingly to the parameters S for a curve, the tangential 
lines, normal lines, and the curvature of the curve can be obtained 
in a direct manner, as shown in Expressions in (7), (20) and (26) . 
This is a very effectively feature useful for a numerical control 
technique which will be described later. Thai: is, this feature will 
lead to a largely reduced computation time, saved sources such as 
memories, and a real-time calculation for the interpolation. 
[0340] 
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In the NC process, keeping the curvature radius of trajectory 
of a tool to a minimum is a significant topic. The interpolation 
that uses splines can be used for computing the minimum curvature 
radius, but such a way involves sophisticated computation 
procedures. In contrast, it is advantageous to use the clothoids 
in various processes such as selection of the radii of cutters, 
because the minimum curvature radius of each segment is normally 
known when the clothoids are used. 
[0341] 

(e) Easiness of motion control: 

The main variable of a curve is a length or the normalized 
length is S, and the equation of this curve is given by a natural 
equation with regard to the length. Hence, by defining the length 
s as a function of the time t, an arbitrary characteristic of motion, 
which is for example an accelerated and decelerated motion, can 
be given. By employing motion curves having good characteristics, 
which have conventionally been used for cams, processing operations 
can be made faster. The length s is given as a value in the existing 
Cartesian space and velocity and acceleration are calculated in 
tangential directions, resulting in that it is not necessary to 
synthesize values given every axis, unlike the conventional 
interpolation method. Additionally, the curvature can be 
calculated with easiness, whereby a centrifugal acceleration of 
an object in motion can be obtained with easiness. Thus control 
can be conducted depending on motion trajectories. 
[0342] 

(6) Production of curve and character of each parameter: 
According to their definitions, a three-dimensional clothoid 
curve has parameters, which have an effect on the curve as follows. 
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Giving the respective parameters allows a three-dimensional 
clothoid curve to be produced as shown in Fig. 49. Table 20 shows 
a summary of the characters of the respective parameters of the 
three-dimensional clothoid curve. 
[0343] 
[Table 20] 



parameter 


meaning 


Po 


moving in parallel a three-dimensional curve 


h 


deciding the size of a three-dimensional curve 


ao, bo 


rotating a three-dimensional curve 


ai, 32/ bi, b2 


deciding the shape of a three-dimensional curve 



[0344] 

2. Interpolation method using a three-dimensional clothoid 

curve : 
[0345] 

(1) Mathematical conditions with smooth connection: 
A single three-dimensional clothoid curve has a limitation 
on expressing the shapes of curves. In this section, with employing 
the numerical control of motion of a machine tool as a main purpose, 
a plurality of three-dimensional clothoid curves 
(three-dimensional clothoid segments) are mutually connected, and 
using these plural three-dimensional clothoid segments, the motion 
of a tool is controlled. 
[0346] 

When two three-dimensional clothoid segments are smoothly 
connected at their end points, this results in a definition that 
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their end positions, tangential lines and curvatures are 
continuously connected, respectively. Using the foregoing 
definition expressions, conditions for those connections can be 
described as below, in which the first three expressions show the 
continuity of positions, the next two expressions show the 
continuity of tangential lines, the next one expression shows the 
agreement of normal lines, and the last expression shows the 
continuity of curvatures. 
[0347] 

[Numeral 92] 

Pxi(l) = PXi^i(0) 

Pyi(i) = Pyi+i(0) 

PZi(l) = Pzi^i(0) 

A(l) = A+i(0) ^''^ 
tanyi(l) = tanyi+i (0) 

'^i(l) = ^w(0) 

[0348] 

These expressions provide sufficient conditions for 
achieving the continuity of tangential lines, normal lines, 
curvatures, and a and P at connecting points, and in some cases, 
these conditions are too strict to be applied. By taking such 
conditions into consideration, those conditions can be changed so 
as to meet the conditions in an original viewpoint, and the changed 
expressions are as follows. 
[0349] 

[Numeral 93] 
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Pxi(l) = Pxi^,(0) 

Pyi(i) = Pyi-fi(0) 

Pzi(l) = Pzi^,(0) 
cos[ai 0.)-oc;+i(0)] = l 

cos[Aa)-A+i(0)] = l ^''^ 
tano/i(l) = tanyi+i(0) 

'^ia) = '^i+i(0) 

[0350] 

Further, when a relationship of 
[Numeral 94] 

cos[ai (l)-ai+i (0)] = 1 

is taken into account, 
[Numeral 95] 

tanyi(l) = tanyi+i(0) 

is replaced by the following conditions. 
[0351] 

[Numeral 96] 

tanyi(l) = tanyi+i (0) 

g'i (1) _ a'M (0) 
y^'i (l)cosai(l) >^'i+l (O)cos«i^i(0) 
V «'i (0) = ^'i+i (0)>^'i (1) 

[0352] 

[Numeral 97] 

As a result, it is understood that satisfying the following 
conditions leads to achievement of the object. 
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Pxi(l) = Pxi^,(0) 

Pyi(i) = Pyw(0) 

Pzi(l) = PZi^i(0) 
cos[ai (l)-ai^, (0)] = 1 
cos[y^i(l)-A-.i(0)] = l ^28) 
«i'(l)>^w(0) = c^iVi(0)>^iXl) 

[0353] 

In Expression (28), the first three expressions show the 
continuity of positions, the next two expressions show the 
continuity of tangential directions, the next one expression shows 
the agreement of normal lines, and the last expression show the 
continuity of curvatures, respectively. To perform a 

G^-continuous interpolation, it is required that two 
three-dimensional clothoid curves should meet the seven 
conditional expressions in Expression (28) at their end points. 
[0354] 

The continuity (G stands for the acronym of Geometry) will 
now be complemented. Fig. 50 illustrates conditions required for 
the G^-continuous interpolation. 
[0354] 

G° continuity is that two three-dimensional clothoid curves 
positionally agree with each other at their end points, G^ 
continuity is that tangential directions of those agree with each 
other, and G^ continuity is that osculating planes (normal lines) 
and curvatures respectively agree with each other. In Table 21 
shown below, comparison will now be made between C°-C^ continuity 
used by spline curves and G°-G^ continuity used in clothoid curves 
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according to the present invention. 

[0356] 
[Table 21] 



C°: positions 


G°: positions 


C^: the primary differential 
coefficients 


G"*": tangential directions 


C^: the secondary differential 
coefficients 


G2: osculating planes (normal 
lines) and curvatures 



[0357] 

In terms of consideration of the continuity of two 
three-dimensional clothoid curves, the interpolation conditions 
are made more stricter as the continuity degrees advance from 
to and to and from G° to gS and to G^. Though the continuity 
requires that the size direction of the tangential lines agree with 
each other, it is sufficient that the G^ continuity requires the 
agreement of only the tangential directions. For smoothly 
connecting the tangential lines between two three-dimensional 
clothoid curves, it is preferable to create the conditional 
expressions on the G^ continuity. Creating conditional 
expressions based on the continuity, like the spline curves, 
results in too strict conditions, because the creation inevitably 
involves with a condition that the sizes of tangential lines should 
be made agree with each other, even though such a condition has 
no geometrical relationship. Creating the conditional expressions 
on the G^ continuity is advantageous in that the amplitudes of 
primary differential coefficients are set to any values freely. 
[0358] 
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In the continuity, osculating planes (i.e. , normal lines) 
are made to agree with each other. The osculating planes, as shown 
in Fig. 51, mean planes SI and S2 in which a curve C is included 
locally. In Fig. 51, an example is shown where the osculating 
planes SI and S2 are discontinuous at a point P, regardless of the 
continuity of the tangential directions kept at the point P. When 
consideration is given to the continuity of thee-dimensional curves, 
the matter which comes next to the agreement of tangential 
directions is an agreement of osculating planes. A discussion of 
curvatures should be based on an agreement of the osculating planes, 
and if not so, the discussion is meaningless . Making the osculating 
planes agree with each other should precede making the curvatures 
agree with each other. A condition satisfying the continuity 
is that the coordinates, tangential directions, osculating planes 
(normal lines) , and curvatures are respectively made to agree with 
each other between two three-dimensional curves. 
[0359] 

(2) Practical computation procedures: 

There are provided two types of computation procedures. 

[0360] 

(a) By setting the parameters h, a and p of a curve to produce 
a single three-dimensional clothoid curve, the parameters of the 
next three-dimensional curve are decided to meet Expression (28) 
at an end point of the produced curve. In this way, 
three-dimensional clothoid curves connectable in turn in a smooth 
manner can be produced. Using these computation procedures, the 
curve parameters can be computed easily, and a solution on this 
computation way is called a sequential solution. This computation 
way enables the production of a variety of shapes of curves in an 
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easier manner, but it is impossible to explicitly specify the 

connecting points through which the curves pass. 

[0361] 

(b) In order that a group of points specified in advance 
may compose the connecting points of curves, thee-dimensional 
clothoid curves can be connected to each other. In this section, 
there is provided an example in which a short clothoid curve 

(clothoid segment) is produced for every span in a row of points 
given discretely. In such a case, the computation procedures to 
decide the curve parameters so as to meet Expression (28) is more 
complicated than that described in the foregoing item (a), 
requiring a repeated convergence computation. This computation 
involves a series of inverse procedures that the curve parameters 
are decided from connecting conditions, so that a resultant 
solution is called an inverse solution. 

[0362] 

Concerning the inverse solution in the above item (b) , how 
to compute will now be detailed. A question to be solved is 
formulated as follows: 

Unknown parameters: curve parameters 

Constraint conditions: Expression (28) or part thereof 

[0363] 

Depending on questions to be solved, the number of constraint 
•conditions is changed and curve parameters of which number 
corresponds to the number of constraint conditions are set as 
unknown parameters. For example, in the case that the continuity 
of curvatures is not demanded, part of the curve parameters can 
be adjusted freely. Alternatively, when it is demanded those 
curvatures are kept continuous but tangential directions are 
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specified, it is required that the nuinber of three-dimensional 

clothoid curves to be used for the interpolation be increased by 
division so as to increase the nuinber of corresponding unknown curve 
parameters . 
[0364] 

In order to converge the above repeated convergence 
computation in a stabilized manner, the computation should be 
cogitated. To avoid the computation from diverging for speeding 
up the convergence, setting optimum initial values of the unknown 
values is effective. For doing so, it is effective to gain initial 
values for the repeated convergence computation by generating a 
simpler interpolation curve (for example, such a curve is a linear 
spline curve) , which still meets constraint conditions concerning 
given connecting points and/or others, estimating the shape of the 
curve to obtain curve parameters of three-dimensional clothoid 
curves, and using such curve parameters as the initial values. 
[0365] 

Alternatively, without requiring constraint conditions to 
be met at once, a technique by which conditional expressions are 
increased sequentially is still effective as the way for gaining 
a solution with stability. For example, the procedures for 
generating a curve are divided into the following three steps, which 
are executed in sequence. In the first step, interpolation is made 
such that pieces of positional information agree with each other 
and also tangential directions agree with each other. In the 
second step, interpolation is made to allow normal lines to agree 
with each other, and in the third step, interpolation is also made 
to allow curvatures to agree with each other. This technique is 
outlined as a flowchart in Fig. 52. The necessary 
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three-dimensional clothoid curve equations and the definition 
equations for the tangential lines, normal lines, and curvatures 
thereof have already been explained. 
[0366] 

(3) Embodiment of the interpolation method using the 
three-dimensional clothoid curve: 
[0367] 

(a) Flow of interpolation method: 

One embodiment of the technique with which a 
three-dimensional clothoid curve is used to smoothly interpolate 
each interval between points which are part of a row of points will 
now be detailed. Hereinafter, the interpolation that uses a 
three-dimensional curve is referred to as a three-dimensional 
clothoid interpolation and a group of curves to be produced by the 
interpolation is referred, as a whole, to as a three-dimensional 
clothoid curve, which is composed by a plurality of unit curves 
each referred to as a three-dimensional clothoid segment. 
[0368] 

The basic flow of the three-dimensional clothoid 
interpolation is such that the respective parameters of a 
three-dimensional clothoid segment connecting two points being 
interpolated are set to unlcnowns, and a curve is produced by 
obtaining a solution with the Newton-Rapson method, in which the 
solution meeting the conditions that points being interpolated are 
passed strictly and the continuity is kept. This way is outlined 
as a flowchart in Fig. 53. The continuity is that, with regard 
to two three-dimensional clothoid curves, the potions, tangential 
directions, normal directions, and curvatures at end points of the 
curves agree with each other parameter by parameter. 
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[0369] 

(b) Conditions of G^-continuous interpolation: 
Practical conditions which allow points being interpolated 
to be passed strictly and the continuity is kept will now be 
described. 
[0370] 

Now assume a simple case in which there are three points 
Pi={Pxi, Pyi, Pzi), P2={Px2, Py2, PZ2}/ andP3={Px3, Py3/ Pzs) and these 
points are interpolated by using three-dimensional clothoid 
segments. Fig. 54 shows the three-dimensional clothoid 
interpolation between among the points Pi, P2 and P3. When a curve 
connecting the points Pi and P2 is denoted as a curve Ci and a curve 
connecting the points P2 and P3 is denoted as a curve Cz, the unknowns 
in this case are 14 pieces consisting of the parameters from the 
curve Ci, which are aOi, ali, a2i, bOi, bli, b2i, and hi, and the 
parameters from the curve C2, which are a02, al2, a22, bOa, bl2, b22, 
and h2. The subscripts to each character, which will appear in the 
following description, correspond to the subscript to each curve. 
[0371] 

Here, the conditions which allow points being interpolated 
to be passed strictly and the G^ continuity is kept will now be 
considered. First of all, when the condition which allows points 
being interpolated to be passed strictly at a starting point is 
necessarily achieved at the time when the starting point is 
specified, so that the interpolation condition is not necessary 
in this situation, which is clear from the definition of the 
three-dimensional clothoid curve. At the connecting point PI, 
seven interpolation conditions consisting of three positional 
conditions, two tangential vector conditions, and two conditions 
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(about the magnitude and direction) regarding to equations showing 
the curvature continuity are needed. Further, as to the end point, 
three positional conditions are necessary at the point P2 • Thus, 
the conditional expressions total to 10. However, the number of 
unknowns is 14, compared to only the ten conditional expressions, 
so that the unknowns cannot be solved. In order to overcome this 
difficulty, the study according to the present invention was 
conducted on condition that tangential line vectors were given at 
both end points to increase the number of conditions at each end 
point by two so that the conditional expressions and the unknowns 
are equal in number to each other. In addition, deciding a 
tangential direction at the starting point enables aOi and bOi to 
be obtained from the equation defining the tangential direction. 
Considering this, aOi and bOi were not treated as unknowns. In the 
following, consideration will now be given to each condition. 
[0372] 

First, the positional conditions will now be considered. In 
this case, three Expressions (1-1), (1-2) and (1-3) are established 
(hereinafter, ''i'' represents non-negative integers smaller than 
3) . 

[0373] 

[Numeral 98] 

Pxj+hi f cos(aOi -haliS + a2iS2)cos(b0i +bliS + b2iS^)dS-Pxi^i =0 



(1-1) 
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Pyj +hi f'cos(aOi + aljS + a2iS2)sin(b0i + bljS + bliS^)dS - Pyj^, = 
Jo 

(1-2) 

Pzj +hi f'(-sin(aOi + aljS + a2iS^))dS - PZi+, = 0 

JO 

(1-3) 

[0374] 

The, the conditions concerning the tangential directions 
will now be considered. In this case, two Expressions (1-4) and 
(1-5) are established. 
[Numeral 99] 

cos(aOi + al} + a2i - aOj+i ) = 1 (1-4) 
cos(bOi + bli + b2i - bOj^i ) = 1 (1-5) 

[0375] 

Concerning the curvature k, the following Expression (1-6) 
will now be established. 
[Numeral 100] 

/^iW-'^i+lW^O (1-6) 
[0376] 

Finally, the normal direction vector n will nov; be considered. 
The normal vector n of a three-dimensional clothoid curve is 
expressed by Expression (21) . 
[0377] 

Like the decision of the tangential vector u of a 
three-dimensional clothoid curve, the rotation will now be used 
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for considering the normal vector n. Assume that an initial 
tangential direction is (1, 0, 0) and an initial normal direction 
is expressed as (0, cosy, -siny) in which y is a constant. When this 
initial normal direction is rotated in the same way as that for 
tangential lines, the normal line n is expresses as shown in 
Expression (1-7) . 
[0378] 

[Numeral 101] 



n(S) = 



0 



- sin a(S) 0 cos a(S) 



cos /?(S) - sin j5iS) 0 

sin >^(S) cos J3(S) 0 

0 0 1 

sin / cos >^(S) sin a(S) - cos / sin y^(S) 

- sin y sin ;^(S) sin a{S) + cos y cos jSiS) 

— sin y cos Qr(S) 



cosor(S) 0 sin cir(S) 



1 



0 



0 

cos y 

- sin y 



(1-7) 



[0379] 

Making a comparison between Expressions (21) and (1-7) 
reveals that siny and cosy correspond to Expression (1-8) . 
[Numeral 102] 



smy - 



cosy = 



j3'(S)cosaiS) (1-8) 
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[0380] 

That is, it is found from Expression (1-3) that the continuity 
of tany is enough for accomplishing the continuity of the normal 
lines at a connecting point involving in the three-dimensional 
clothoid interpolation. 
[Numeral 103] 

tanr = n-g^ 

[0381] 

In short, it is understood that the condition for holding 
the normal lines continuous is expressed by Expression (1-10) . 
[Numeral 104] 

tany = /i^qv 

^ j3\S)cosa(S) 

[0382] 

Further, when taking the equation of 
[Numeral 105] 

cos[cifi (1) - a^^i (0)] = 1 ( 1-11 ) 

into account, the conditional Expression (1-10) can be replaced 
by the following conditional Expression (1-12) . Specifically, the 
condition for the continuous normal lines is expressed by 
Expression (1-12) . 
[0383] 

[Numeral 106] 

c^'i (0) = (0)>^'i (1) (1-12) 

[0384] 

In stimmary, it is found that the conditions for keeping not 
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only a strict passage through points being interpolated but also 
the continuity at each connecting point are expressed by 
Expression (1-13) . Also, as for the starting and end points, it 
is still enough to select some of the conditions listed in Expression 
(1-13) . 
[0385] 

[Numeral 107] 
PX5(l) = PXiH.i(0) 

Pyi(i) = Pyi+i(0) 

Pzi(l) = Pzi^i(0) 
cos[ai (0)] = 1 

cos[/?i(l)-A+i(0)] = l ^^-'"^ 
«i(l)A+i(0) = «iVi(0)>^i(l) 
(1) = ^i+i (0) 

[0386] 

As described, it is revealed that concerning the conditional 
expressions for the twelve unknowns ali, a2i, bli, b2i, hi, a02, alj, 
a22, b02, bl2, b22, and h2, twelve conditional expressions are 
established as follows (, in which as and p3 represent rotation 
angles in the tangential direction at the point P3) • 
[0387] 

[Numeral 108] 
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PXi(l) = PX2(0) 

Pyi(i) = Py2(0) 

PZi(l) = PZ2(0) 

cos[ai(l)-a2(0)] = l 

COS[A(1)-/?2(0)] = 1 

cc\ (1)>^'2 (0) = a\ (1) 

PX2(1) = PX3(0) (1-14) 

Py2(i) = Py3(0) 

PZ2(1) = PZ3(0) 

C0S[>^2(1)-A] = 1 

[0388] 

Since the twelve equations can be given for the twelve 
unknowns, a solution can be obtained. Practically, the 
Newton-Rapson method is used to solve such equations to have a 
solution . 
[0389] 

Additionally, for the general case in which a row of n-piece 
points is subjected to the interpolation, it is sufficient that 
the non-negative integer i described above is expanded to values 
fulfilling i<n. The remaining matter concerns the number of 
unknowns and the number of conditional expressions. 
[0390] 

For example, suppose that there is a row of ''n-l"-piece points 
and N-piece unknowns and N-piece relational expressions are 
established. In this situation, when one point is added to the 
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point row, the parameters is thus subjected to an increase thereof 
such that the seven clothoid parameters aOn, aln, a2n, bOn, bin, b2n, 
and hn of the three-dimensional clothoid segments Pn-i and Pn are 
added. On the other hand, the conditional expressions are 
subjected to an increase of a total of seven equations consisting 
of three equations for positions at the point Pn-i/ two equations 
for a tangential vector, and two equations (about the magnitude 
and direction) representing a condition for keeping the curvatures 
continuous with respect to the point Pn-i, because the connecting 
points increase by one. 
[0391] 

In the case of n=3, it is known that the unknowns and the 
relational expressions are 12 in number respectively, so that for 
n>3, the number of unknowns is 7 (n-2)+5 and the number of equations 
to be established is also 7 (n-2)+5. In this way, the unknowns and 
the conditions relating to the unknowns are the same in number. 
Thus, in the case of a row of n-piece free points, the similar method 
to that applied to three points can be used to calculate a solution. 
The Newton-Rapson method that utilizes the fact that the 
relationships on Expressions (1-15) and (1-16) are established 
between the unknowns and the conditional expressions was used as 
a solving method for a solution. (The conditions are denoted by 
F, the unknowns by u, and an error Jacobian matrix by J. ) 
[0392] 

[Numeral 109] 

AF = [j]Au (1^15) 
Au = [j]"^ AF (1-16) 
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[0393] 

Accordingly it is understood that a row of n-piece points 
can be subjected to the three-dimensional clothoid interpolation 
in such a manner that points being interpolated are passed strictly 
and the continuity is kept. 
[0394] 

(c) Decision of initial values: 

The Newton-Rapson method needs to have adequate initial 
values to start the search for a solution. Although the initial 
values may be given based on any method, hew to give the initial 
values will now be exemplified in the following. 
[0395] 

3D Discrete Clothoid Splines, which precede the present study, 
have a characteristic that the splines strictly pass points being 
interpolated and the curvatures change smoothly along the distance 
moved from a start point . In the present specification, the initial 
values for the three-dimensional clothoid interpolation are 
decided through computation with the use of a polygon Q made on 
3D Discrete Clothoid Splines of r=4, as shown in Fig. 55. 
[0396] 

The 3D Discrete Clothoid Splines will now be complemented 
as follows. As shown in Fig. 56, a polygon P of which apexes are 
a row of points being interpolated is first made, and new apexes 
are insertedly placed, the same number of pieces, between the 
apexes of the polygon Q so that a polygon Q meeting PczQ is made. 
Here suppose that the number of apexes of the polygon P is n-pieces. 
This supposition results in that the polygon Q has apexes whose 
number is ''rn'' pieces if the polygon is closed, but ''r (n-l) +1'' pieces 
if the polygon is open. Hereinafter, each apex is denoted by qi. 
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in which the subscript is a serial nuntoer starting from the starting 
point. A vector k is decided at each apex, where the vector has, 
as a direction, a binormal vector b and has, as a magnitude, a 

curvature k. 
[0397] 

In cases where Expression (1-17), which is listed later, 
requiring the apexes be equidistant therebetween is met and a 
condition is established which is the nearest to a specific 
condition where the curvature is proportional to the distance moved 
from the starting point (i.e., the function shown in Expression 
(1-18) listed later is minimized), a certain polygon Q is made, 
which is called 3D Discrete Clothoid Splines. 
[0398] 

[Numeral 110] 

qi-iQi = ^M^il (qi ^P) (1-17) 



i=l 

(1-18) 



[0399] 

In the case of the 3D Discrete Clothoid Splines, the frenet 
frame of each apex is already obtained, so iihat the parameters ao 
and bo are computed based on the unit tangen-ial vector t thereof. 
This tangential vector t has already been known at the time of 
obtaining the polygon Q, and both the vector t and the expressions 
of the tangential lines to the three-dimensional clothoid curve 
are used to obtain the tangential rotation angles a and p at the 
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respective apexes of the polygon Q. Thus the initial values to be 
given to the parameters ao and bo of each curve are decided. In 
a three-dimensional clothoid segment starting from the stating 
point, the values thereof is given as the initial values. 
[0400] 

[Numeral 111] 

COS COS a 

u = ^ s'mjScosa 
-sin a 



(1-19) 



[0401] 

In addition, when taking it into consideration the fact that 
3D Discrete Clothoid Splines allows its apexes to be aligned at 
equal distances, the point q4i+i in Fig. 55 can be approximately 
estimated as having a curve length variable S of 1/4 . In the similar 
way to this, the point q4(i+i)-i can be approximately estimated as 
having a curve length variable S of 3/4. In consideration of these 

values together with the expression of a of a three-dimensional 
clothoid curve, the following Expression (1-20) is established. 
[0402] 

[Numeral 112] 
a04i +^al4i +f-jl a24i=a04i+i 



a04i +-al4i +1 - 



a24j = aO 



(1-20) 



4(i+l)-l 



[0403] 



Since this expression is a two-dimensional simultaneous 
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equation to which unknowns are al4i and a24i/ this equation is solved 
to obtain the initial values of the parameters ai and a2. Similarly 
to this, the initial values of the parameters bi and b2 can be decided. 
[0404] 

The remaining unknown to be handled in this section is the 
curve length h, of which initial value is computed using the 
expression of the curvature of the three-dimensional clothoid curve. 
The curvature of a three-dimensional curve is expressed by 
Expression (1-21) . 
[0405] 

[Niomeral 113] 

Va'^+yg''cos'a 

[0406] 

This expression is deformed into Expression (1-22), which 
gives a decided initial value. 
[Numeral 114] 



7(al4i +2a24i)^ + (b^i +2b24i)^ cos^ (a04i + al4i +a24i) 

h4i = ^ 

^4(i+l) 

(1-22) 

[0407] 

As described above, the initial values of the seven 
three-dimensional clothoid parameters can be decided. Using 
these decided initial values under the condition that the 
continuity described in the item (b) is still held, respective 
approximate values of the parameters of each curve were obtained 
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by the Newton-Rapson method. The resultant parameters are used to 
produce three-dimensional clothoid segments, and each interval 
between any two points was subjected to interpolation on the 
three-dimensional clothoid curves. 
[0408] 

(d) Example of interpolation: 

An example of the interpolation will now be described, in 
which the foregoing technique was actually applied to the 
three-dimensional clothoid interpolation directed to four points 
of (0.0, 0.0, 0.0), (2.0, 2.0, 2.0), (4.0, 0.0, 1.0), and (5.0, 
0.0, 2-0). A perspective view of the three-dimensional clothoid 
curve produced by the interpolation is illustrated in Fig . 57 . Fig . 
57 shows a solid line curve representing uhe three-dimensional 
clothoid curve and linear lines depicted by broken lines, dashed 
lines and chain double-dashed lines representing patterns of 
changes in the curvature radius in which, at each point on the curve, 
an amplitude is shown in the logarithm (curvature radius + logarithm 
natural e) and a direction is shown in the normal vector. 
[0409] 

Furthermore, Table 22 represents the parameters of each curve, 
while Table 23 lists shifts of the coordinate, tangential line, 
normal line and curvature at each connecting point- These tables 
reveal that a three-dimensional clothoid curve which meets the 
requirement for the continuity at each connecting point was 
produced. Fig- 58 is a graph showing changes in the curvature, in 
which the axis of abscissas represents the distance moved from the 
starting point and the axis of ordinate represents the curvature. 
[0410] 
[Table 22] 
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Parameters of each three-dimensional clothoid segment 
Curve 1 (curvature radius change pattern: broken lines) 

a 0.657549 - 1.05303S + 1. 845843^ 

(J= 1.03297 + 1.29172S - 2.551183^ 

h = 3.82679 

Po = (0.0, 0.0, 0.0) 

Curve 2 (curvature radius change pattern: dashed lines) 
a= 0.135559 + 2.185373 - 2.698713^ 
|3= -0.226655 - 3.156033 + 3.032983^ 
h = 3.16932 
Po = (2.0, 2.0, 2.0) 

Curve 3 (curvature radius change pattern: chain double-dashed lines) 
a= -0.377569 - 1.459223 + 0.9849453" 
P= -0.349942 + 1.321983 - 0.8732673'- 
h = 1.43987 
Po = (4.0, 0.0, 1.0) 

[0411] 
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[Table 23] 



Shifts of coordinate, tangential line, normal line and curvature 
at each connecting point 

Connecting point at which curves 1 and 2 are mutually connected 
Coord: ( 1.16 x 10"^ 2.00 x 10"% 3.82 x 10"^ 

Tvector: ( 7.59 x 10■^ 1.50 x 10"^ 2 . 95 x 10"^ ) 

Nvector: ( 2.93 x 10"% 9.19 x 10"% -7.57 x 10"^ ) 

Curvature: 3.06 x 10'*^ 

Connecting point at which curves 2 and 3 are mutually connected 

Coord: ( -4.33 x 10"% -1.64 x 10"% 1.11 x 10'^ ) 

Tvector: ( 2.06 x 10"% 2,33 x 10"% 1.97 x 10"^ ) 

Nvector: ( 3.30 x 10"% 1.19 x 10"% -3.23 x 10"^ ) 

Curvature: 5.96 x 10"^ 



[0412] 

(4) G2-continuous three-dimensional clothoid 

interpolation in consideration of control of value at each of both 
ends : 

(a) Interpolation conditions and unknowns: 
As stated in section (3), if a curve is open and there are 
n-piece points being interpolated, the row of points can be 
interpolated three-dimensionally with the help of n-1 piece curves. 
If it is requested that the curves pass each point in a strict manner, 
the unknowns of each three-dimensional clothoid segment are seven 
in number, which are ao, ai, a.2, bo, bi, b2, and h. Accordingly, as 
a whole, the number of unknowns is 7 (n-1) pieces. Meanwhile, the 
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number of conditional expressions total to 7 (n-2) +3 pieces, because 
there are seven unknowns concerning the coordinates, tangential 
line, normal line and curvatures at every n-2''-piece connecting 
points, and there are three coordinates at -he end point. In the 
technique in section (3) , tangential vectors at each of the starting 
and end points were added to the conditional expressions so that 
the conditions increase by four, whereby the conditional 
expressions and the unknowns were made to be mutually equal in 
number. 
[0413] 

In cases the tangential line, normal line and curvatures are 
controlled at each of the starting and end points and the 
interpolation is conducted with the continuity still held, the 
conditions increase by 2 pieces, which are with respect to the normal 
line and curvatures at each of the starting and end points, that 
is, an increase of a total of 4 pieces, compared to the case where 
the control of tangential lines is made at both ends. In short, 
the number of conditional expressions totals to 7n-3 pieces. In 
this case, the unknowns are smaller in number than the conditions, 
the Newton-Rapson method is unavailable for a solution. Hence any 
technique has to be used to increase the number of unknowns. 
[0414] 

In the present case, the above difficulty was overcome by 
newly inserting points being interpolated so that the unknowns and 
the conditional expressions became equal in number to each other. 
For instance, the number of unknowns is larger than the conditional 
expressions by 4, two new points are inserted and two of the 
coordinates at the perspective points are handled as unknowns. 
[0415] 
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In this case, since the connecting points increase by 2, the 
conditions increase by a total of 14-piece ones, which consist of 
7-piece conditions (coordinates, tangential line, normal line and 
curvatures) for each connecting point. On the other hand, the 
unknowns increase by 2 which is for each three-dimensional clothoid 
segment, the unknowns increase as a whole by 14 pieces, which is 
composed of 7 pieces of ao, ai, a2, bo, bi, b2/ and h for each segment. 
In this case, the number of points included in the row of points 
is n+2 pieces, the whole unknowns are 7(n+l} pieces and the whole 
conditional expressions are 7(n+l)+4 pieces. Further, when it is 
supposed that two of the coordinates of the newly inserted points 
are treated as unknowns, the number of unknowns results in an 
increase of 4 . As a result, the unknowns and the conditional 
expressions are both 7 (n+2) -3 in number, whereby a solution of the 
unknowns can be obtained. In this way, inserting new points makes 
it possible to perform the interpolation with the respective points 
passed strictly, the continuity held, and the tangential lines, 
normal lines, and curvatures at both end points controlled. 
[0416] 

Furthermore, a generalized case will be discussed. In the 
case of interpolating a row of n-piece points in a state where 
m-piece items are controlled at both end points, consideration is 
given to the number of points to be inserted and to the number of 
coordinates to be treated as the unknowns at each inserted point. 
As state previously, as long as a curve is open, a row of points 
can be interpolated with the help of ''n-l''-piece curves. If the 
respective points are subjected to a strict passage, each 
three-dimensional clothoid segment has the seven unknowns of ao, 
ai, a2, bo, bi, ba, and h, so that the unknowns total to 7 (n-1) pieces- 
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In contrast, the conditional expressions are as a whole 7(n-2)+3 
pieces, because, every ''n-"2'''-piece connecting points, there exist 
seven expressions on the coordinates, tangential line, normal line, 
and curvatures and three coordinates at an end point. Thus, the 
conditional expressions are less in number than the unknowns by 
4 . That is, this means that items to be controlled at both end points 
are 4 or more. In the following description, assumption is made 
such that m is a nonnegative integer of 4 or more and k is a 
nonnegative integer of 2 or more, under which how to make both the 
conditional expressions and the unknowns equal in number to each 
other in response to inserting new points will now be described. 
[0417] 

(i) In the case of m=2k: 

In cases where it is required that a total of ''m=2k''-piece 
items be controlled at both end points, the number of unknowns is 
7(n-l) pieces in total and the number of conditional expressions 
is 7(n-l)-4+2k pieces in total. In this situation, the number of 
excessive conditional expressions is 2k-4 pieces. When it is 
considered that ''k-2''-piece points are newly inserted, the number 
of three-dimensional clothoid segments increases by k-2 pieces, 
while the connecting points increase by k-2 pieces as well. As a 
result, the unknowns total up to 7 (n+k-3) pieces and the conditional 
expressions total up to 7 (n+k-3) -4+2k pieces- In the case that, 
of the values at the coordinates of each of the newly inserted points, 
two values (for example, x and y) are treated as being unknowns, 
the unknowns total up to 7 (n+k-3) +2 (k-2) pieces and the conditional 
expressions total up to 7 (n+k-3) +2 (k-2) pieces, permitting both 
the unknowns and the conditional expressions to be equal in number 
to each other. 
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[0418] 

(ii) In the case of m=2k+l: 

In cases where it is required that a total of ''m=2k+l ''-piece 
items be controlled at both end points, the number of unknowns is 
7(n-l) pieces in total and the number of conditional expressions 
is 7{n-l)+2k-3 pieces in total. In this situation, the number of 
excessive conditional expressions is 2k-3 pieces. When it is 
considered that ^'k-l''-piece points are newly inserted, the number 
of three-dimensional clothoid segments increases by k-1 pieces, 
while the connecting points increase by k-1 pieces as well. As a 
result, the unknowns total up to 7 (n+k-2) pieces and the conditional 
expressions total up to 7 (n+k-2) -3+2k pieces. In the case that, 
of the values at the coordinates of each of the newly inserted points, 
two values (for example, x and y) are treated as being unknowns, 
the unknowns total up to 7 (n+k-2) +2 (k-2) pieces and the conditional 
expressions total up to 7 (n+k-2) +2k-3 pieces, resulting in that 
the conditional expressions are larger than the unknowns by one. 
Thus, for the case of m=2k+l, at one of the inserted points, only 
one of the values of the coordinate at the one point is treated 
as being an unknown. This countermeasure allows the unknowns to 
be 7 (n+k-2) +2 (k-2) pieces in total and the conditional expressions 
to also be 7 (n+k-2) +2 (k-2) pieces in total, whereby the unknowns 
and the conditional expressions are equal in number to each other. 
[0419] 

As stated above, in the present method, in accordance with 
the number of conditional expressions to be added, the number of 
values chosen as unknowns from the coordinates of inserted points 
can be adjusted. This makes it possible that, in various occasions 
in which parameters, such as a tangential rotation angle a, which 
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are other than the tangential line, normal line and curvatures, 
are controlled, the unknowns can be equalized in number to the 
conditional expressions. In consequence, from a theoretical 
viewpoint, each value at both end points can be controlled. Table 
24 is provided to show, as a summary, correspondences among the 
items to be controlled, the number of unknowns and the number of 
conditional expressions . 
[0420] 
[Table 24] 



Items to be controlled at both end points, the number of unknowns, 
and the number of conditional expressions in n-point interpolation 



the number of 
itons to be 
controlled 


the number of 
conditional 
expressions 
to be 
increased 


the number 
of points 

to be 
inserted 


the nurrber of 
coordinates being 
handled as unknowns 
per point 


the number of 
unknowns to be 
increased 


4 


0 


0 


0 


0 


5 


1 


1 


1 


1 


6 


2 


1 


2 


2 


7 


3 


2 


1-piece point : 2 
1-piece point : 1 


3 




2k 


2k-4 


k-2 


"k-2"-pieca points 
: 2 


2k-4 


2k+l 


2k-3 


k-1 


"k-2"-piece points 
:2 

1-piece point : 1 


2k-3 



*k : nonnegative integer of 2 or more 



[0421] 
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(b) Technique: 

As shown in Figs. 59 and 60, the interpolation that uses a 
three-dimensional clothoid controlling each value at the starting 
and end points is carried out on the following operation flow. 

Step 1) Of the conditions to be controlled, only 4 conditions 
are used to perform interpolation in which points being 
interpolated are subjected to a strict passage and the continuity 
is kept, with a curve produced on the interpolated results. 

Step 2) New points are inserted into the produced curve, 
before the conditional expressions and the unknowns are subjected 
to adjustment in terms of the number thereof. 

Step 3) The curve parameters in Step 1 are used as initial 
values for obtaining approximate values of parameters of each curve 
by the Newton-Rapson method, the approximate values meeting the 
conditions to be targeted. 
[0422] 

Each Step will now be complemented as follows. First, at 
Step 1, a curve is produced by using the technique described in 
section (3), if the tangential direction is required to be 
controlled. Even if the tangential direction is not required to 
be controlled, initial values, which are the same as ones produced 
by the technique described in section (3) , are used as initial values 
required for obtaining the parameters of the curve. 
[0423] 

Then at Step 2, new points are inserted into the curve for 
adjustment conditions and unknowns in terms of their numbers. 
During this step, the number of points to be newly inserted in an 
interval between points being interpolated is required to be one 
or less, whenever possible. Further, the point to be inserted is 
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at a central position of each three-dimensional clothoid segment 
produced at Step 1 and inserted to connect points being interpolated. 
Still further, the insertion of the points to be inserted is carried 
out in sequence from both ends of the curve. In other words, the 
first inserted points are a central point betv/een the starting point 
and the adjacent point located next thereto and a further central 
point between the end point and the adjacent point located next 
thereto. 
[0424] 

Lastly, the description will now be given to Step 3, wherein 
it is required to decide initial values for the Newton-Rapson method 
employed in this step. For this purpose, the curve into which the 
new points have been inserted is divided using the technique, 
described in section 1-4, fro dividing the three-dimensional 
clothoid curve, and the initial values are decided based on 
respective values of the divided curves. If the curve will not be 
subjected to the insertion of any points, the as-produced initial 
values of the curve, produced in Step 1, are used. In this way, 
the initial values given to the respective pcirameters of the curve 
in Step 3 have been decided. Using these initial values, the 
computation on the Newton-Rapson method is conducted to provide 
parameters, and these parameters are used to produce a 
three-dimensional clothoid curve. That is, the interpolation has 
been made by the three-dimensional clothoid curve that fulfills 
the targeted conditions in each interval between points. 
[0425] 

(c) Example of interpolation: 

An actual example of the three-dimensional clothoid 
interpolation will now be given by Table 25, in which conditions 
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are listed as to tangential lines, normal lines, and curvatures 
at both ends so that control should be conducted to meet those 
conditions. The sequential numbers are given to the points being 
interpolated which are to be subject to a strict passage of the 
line, so that the points Pi, P2 and P3 are denoted. 
[0426] 
[Table 25] 



Conditions for respective points being interpolated and starting 
and end points 





coordinate 


unit tangential vector 


principal normal vector 


curvature 


Pl 


(0,0,0) 


(Cos(e),Sijri(e),0 ) 


(-Sin (9) , Cos (9), 0 ) 


0.2 


P2 


(4,-4,-4) 








P3 


(8,-4,-5) 


(1,0,0) 


(0,-1,0) 


0.2 



* e=-(7T/6) 



[0427] 

Under the conditions listed above, zhe interpolation was 
conducted actually, which resulted in the figure shown in Fig. 61. 
A solid-line curve represents a three-dimensional clothoid curve, 
while curves depicted by broken lines, dashed lines, chain 
double-dashed lines, and chain triple-dashed lines represent 
patterns of changes in the curvature radius of each curve. Fig. 
62 shows a graph representing the relationship betv/een the distance 
moved from the starting point of each curve and its curvature, the 
graph being shown depending on the types of lines shown in Fig. 
61 . As understood from Table 26, the produced curves meet the given 
conditions . 
[0208] 
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[Table 26] 



Differences between given values and produced values as to 
tangential lines, normal lines, and curvatures at starting and end 
points of each produced curve 





coordinate 


unit tangential 
vector 


principal norrral 
vector 


curvature 




given 
value 


{0.0, 0.0, 0.0} 


{0.8660, -0.5, 0.0} 


{0.5,0.8660,0.0} 


0.20 


Pi 


value on 
produced 
curve 


{0.0, 0.0, 0.0} 


{0.8660, -0.5, 0.0} 


{0.5000, 0.8660, 0.0} 


0.20 




difference 


{0.0, 0.0, 0.0} 


{0.0, 0.0, 0.0} 


{0.0, 0.0, 0.0} 


0 




given 
value 


{8.0, -4.0, -5.0} 


{1.0, 0.0, 0.0} 


{0.0, -1.0, 0.0} 


0.20 


P3 


value on 
produced 
curve 


{8.0, -4.0, -5.0} 


{1.0, 0.0, 0.0} 


{0.0, -1.0, 0.0} 


0.20 




difference 


{0.0, 0.0, 0.0} 


{0.0, 0.0, 0.0} 


{0.0, 0.0, 0.0} 


0 



[0429] 

(d) Control of value at central point: 

The technique described in item (d) has enabled both the 
control of each value at both end points and the G^-continuous 
interpolation. In the next place, the control of values at each 
central point, not both end points, will now be described. 
[0430] 

For example, for interpolating a row of points shown in Fig. 
63, an assumption is made such that both a tangential line and a 
normal line are controlled at a central point Pc- It should be noted 
that the technique described so far will not be available to the 
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control of values at central points.. A solution to this difficulty 

is to divide the row of points into two ones so that the control 

can be effective. 

[0431] 

Specifically, the interpolation should be done on individual 
divided curves Ci and C2 with a central point Pc therebetween, without 
interpolating the whole row of points at once. In such a case, the 
central point Pc is to be located at an end of each divided curve, 
with the result that the technique described in item (b) can be 
used for the control. 
[0432] 

Therefore, as described above, a curve division is done at 
a point that represents values to be controlled, the control for 
interpolation is applied to values at both ends of the divided curve, 
and the resultant curves are connected to each other. This way 
theoretically enables the three-dimensional clothoid 
interpolation which controls the tangential line, normal line, and 
curvature at each point. 
[0433] 

(5) Three-dimensional clothoid interpolation controlling 
tangential line, normal line, and curvature at both ends: 
[0434] 

(a) Flow of technique: 

An interpolation technique using the three-dimensional 
clothoid to control each value at staring and end points is performed 
by a procedure flow shown in Fig. 64, which is as follows. In the 
following, the description will be given along such a flow. 
[0435] 

(b-1) Giving points being interpolated: 
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In an example in this section, three points {0.0, 0.0, 0.0}, 
{5.0, 5.0, 10.0}, {10.0, 10.0, 5.0} were designed in the 
three-dimensional space. The other conditions, such as tangential 
liens, normal lines, and curvatures given to each point, are 
summarized in Table 27. 
[0436] 
[Table 27] 



Points being interpolated and conditions for parameters at starting 
and end points: 





coordinate 


unit tangential 
vector 


principal norrtel 
vector 


curvatmre 


Pl 


(0.0, 0.0 ,0,0) 


{0.0, 1.0, 0.0} 


{1.0, 0.0, 0.0} 


0.1 


P2 


(5.0, 5.0, 10.0) 








P3 


(10.0, 10.0, 5.0) 


{1.0, 0.0, 0.0} 


{0.0, -1.0, 0.0} 


0.1 



[0437] 

(b-2) Production of 3D DCS of r=4 : 

The Newton-Rapson method needs to have adequate initial 
values to start the search for a solution. The preparation for 
obtaining the initial values will now be performed. 3D Discrete 
Clothoid Splines, which is a preceding study to the present study 
according to the present application, is characterized in that 
points being interpolated is subjected to a strict passage and the 
curvature smoothly changes with changes in the distance moved from 
a starting point. Hence, in the present study, a polygon Q on 3D 
Discrete Clothoid Splines of r=4 is produced as shown in Fig. 65, 
and this polygon is used to compute and decide initial values for 
the three-dimensional clothoid interpolation. This polygon was 
actually produced from a row of points, which is shown in Fig. 66. 
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The coordinates of the apexes of the produced polygon are listed 
in Table 28. 
[0438] 
[Table 28] 



Coordinates of apexes of produced polygon 





coordinates of apexes 


Pi 


{0.0, 0.0, 0.0} 




{0.4677, 0.4677, 3.1228} 




{0.9354, 0.9354, 6.2456} 




{2.3029, 2.3029, 9.4966} 


P2 


{5.0, 5.0, 10.0} 




{6.7095, 6.7095, 9.9244} 




{8.0655, 8.0655, 8.4732} 




(9.0327, 9.0327, 6.7366} 


P3 


{10.0, 10.0, 5.0} 



[0439] 

(b-3) Decision of initial values: 

Obtaining a solution on the Newton-Rapson method involves 
decision of initial values of respective unknowns. According to 
the present technique, the polygon Q produced in section b-2 is 
used to obtain approximate values of the respective unknowns, and 
those approximate values are subjected to the decision of the 
initial values. In the case of handling 3D Discrete Clothoid 
Splines, the frenet frame of each apex has already been acquired. 
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Parameters ao and bo are thus obtained from the unit tangential 
vector t of the polygon Q produced in section b-2 . This tangential 
vector t has already been known since the polygon Q was obtained, 
so that both this vector t and the expression for a tangential line 
of a three-dimensional clothoid curve are used to compute 
tangential rotation angles a and p. These angles allow the initial 
values of the parameters ao and bo of each curve to be decided. In 
addition, for a three-dimensional clothoid segment starting from 
a starting point, those angles provide initial values of the 
parameters . 
[0440] 

[Numeral 115] 

COS p COS a 
u = sin PcQsa 
-sin a 



[0441] 

When it is taken into account that 3D Discrete Clothoid 
Splines provide apexes poisoning at equal distances, it can be 
approximated that the curve length variable S at a point q4i+i in 
Fig. 65 is 1/4. Similarly to this, it can be approximated that the 
curve length variable S at a point q4(i+i)-i is 3/4. In consideration 
of both the approximated variables and the expression concerning 
a of the three-dimensional clothoid curve, the following expression 
is realized. 
[0442] 

[Numeral 116] 
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a04i +-al4i + 



^1 ^2 



a04i +-al4i + 



v4y 

.4, 



a24i - a04j+i 

a24i = ^^4iM)-l 



[0443] 

Since this expression is a two-dimensional simultaneous 
equation to which unknowns are al4i and a24i, this equation is solved 
to obtain the initial values of the parameters ai and' 32- Similarly 
to this, the initial values of the parameters bi and b2 can be decided. 
[0444] 

The remaining unknown is a curve length h, of which initial 
value is calculated by solving the expression defining the 
curvature of the three-dimensional clothoid curve. The curvature 
of the three-dimensional clothoid curve can be expressed by the 
following. 
[0445] 

[Numeral 117] 



fC = 



yja'^+/3'^ cos^ a 



This expression can be developed into the following, on which 
the initial value of h is decided. 

[Numeral 118] 



= 



•^(al4i +2a24i)^ +(bl4i + 2b24i )^ cos^ (a04i +al4i +a24i) 



''^4(1+1) 
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[0446] 

As described, the initial values of the seven 
three-dimensional clothoid parameters can be decided. 
[0447] 

The initial values actually obtained on the foregoing 
technique are listed in Table 29. 
[0448] 

[Table 29] 



Initial values 





<3o 


0.0 (known) 


curve 

connecting 
points Pi and 

P2 


ai 


-0.2684 




1.0739 


bo 


n/2 (known) 


bi 


0.0 


b2 


0.0 




h 


12.7684 




3o 


-0. 1648 


curve 


<3l 


3.2061 


connecting 


32 


-2.6327 


points P2 and 


bo 


0.7853 


P3 


bi 


0.0 




b2 


0.0 




h 


9.6752 



[0449] 

(b-4) Three-dimensional interpolation with strict passage 
through respective points and continuity: 
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The initial values decided in section (b-3) are used to obtain 
approximate values of parameters of each curve by using the 
Newton-Rapson method, under the condition that the continuity 
is kept. Using the resultant parameters, three-dimensional 
clothoid segments are produced, and then each span between points 
in a row of points is interpolated with the three-dimensional 
clothoid curve. 
[0450] 

In this three-dimensional interpolation for three points, 
practical conditions satisfying a strict passage through points 
being interpolated and the continuity will now be described. Fig. 
67 shows the three-dimensional clothoid interpolation for points 
Pi, P2 and P3. A curve connecting the points Pi and P2 is denoted 
by a curve Ci and a curve connecting points P2 and P3 is denoted 
by a curve C2. Since aOi and bOi are already known, the unknowns 
totals up to 12 pieces consisting of parameters ali, a2i, bli, b2i 
and hi of the curve Ci and parameters aOs/ al2, a22/ b02, bl2/ b22 
and h2 of the curve C2. The subscripts to characters, which will 
appear hereinafter, are assigned to correspond to the subscripts 
to respective curves, in which the coordinates, tangential rotation 
angles a and p, normal line and curvature of each curve are expressed 
respectively by Pxi, Pyi, Pzi, ai. Pi, ni and Kl, which are functions 
of the curve length variable S. 
[0451] 

First of all, from the definition of rhe three-dimensional 
clothoid curve, the condition that the strict passage through 
points being interpolated should be kept at the point Pi is 
inevitably achieved whenever the starting point is given. A 
tangential direction at the point Pi is also given as a known value. 



175 

so that no particular specification for the continuity is needed 

at the point Pi- 

[0452] 

The next to be considered is the point P2. This point P2 is 
a connecting point to connect the curves with each other, so that 
the continuity requires that the position, tangential line, 
normal line, and curvature should be continuous thereat. That is, 
the conditions which should be realized at the point P2 are as 
follows • 
[0453] 

[Numeral 119] 
PX,(1) = PX2(0) 

Pyi(i) = Py2(0) 

PZ,(1) = PZ2(0) 

cos[ai (1) - (^)] = 1 

COS[A(1)->^2(0)] = 1 

ni(l)-n2(0) = l 
^i(l) = 7^2(0) 

[0454] 

Lastly, the consideration is given to the point P3. This 
point P3 is an end point. This means that the necessary conditions 
to be met are abut only the position and tangential line, so that 
the following five conditions are realized, in which as and P3 are 
tangential rotation angles a and P to decide a tangential vector 
at the end point to be given, 
[0455] 

[Numeral 120] 
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PX2(1) = PX3 

Py2a) = Py3 

PZ2(1) = PZ3 
COS[«2(l) -«3] = 1 
C0S[>^2(1)->^3] = 1 
[0456] 

Hence, it can be understood that, as for the twelve unknowns 
all, a2i, bli, b2i, hi, aOa, al2, a22, bOz, bl2, b22 and ha, the twelve 
conditional expressions are provided as follows. These 
expressions can thus be suinmarized in a list form in the following. 
[0457] 

[Numeral 121] 
PXi(l) = Px2(0) 

Pyi(i) = Py2(0) 

PZi(l) = PZ2(0) 

cos[ai (1) - (0)] = 1 

COS[A(1)->^2(0)] = 1 

ni •n2 =1 

PX2(1) = PX3 

Py2(l) = Py3 

PZ2(1) = PZ3 

C0S[a2(l) -6(^3] = 1 

[0458] 

As described, the twelve expressions are realized for the 
twelve unknown, so that solutions to the unknowns can be found. 
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The Newton-Rapson method is applied to these expressions for 
solutions, which are listed in Table 30, together with the initial 
values . 
[0459] 
[Table 30] 



Initial values and solutions 







initial value 


solution 




^0 


0.0 ( known ) 


— 


curve Ci 
connecx-ing 
points Pi and 


ai 


-0.2684 


-5. 4455 




1.0739 


5.4122 




71/ 2 (known) 






0.0 


-3.8590 




0.0 


3. 1003 




h 


12.7684 


13.5862 




ao 


-0.1648 


-0.033258 


curve C2 
connecting 
points P2 and 
P3 


ai 


3.2061 


3.6770 


a2 


-2.5327 


-3. 6437 


bo 


0.7853 


0.8120 


Jbi 


0.0 


1. 6006 


b2 


0.0 


-2.4126 




H 


9.6752 


9.2873 



[0460] 

(b-5) Production of curve: 

Fig. 68 shows, in a parallel form, both a curve produced based 
on the parameters obtained in section (b-4) and the polygon produced 
in section (b-2) . The solid curve line denotes the curve Ci and 
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the broken curved line denotes the curve C2. At this stage, there 
are provided as three-dimensional clothoid curves with tangential 
directions controlled at the stating and end points and the 
continuity kept- 
[0461] 

(b-6) Conditional expressions and unknowns: 
Now assume that the normal lines and curvatures at the 
starting point Pi and end point P2 are given by values shown in Table 
27. In order that the normal lines and curvatures are further 
controlled at the starting and end points, it is necessary to 
increase the number of conditions at each of the starting and end 
points by two. However, in a state where the number of conditions 
is increased by 4, it is impossible to obtain a solution meeting 
the conditions, due to imbalance in number between the unknowns 
and the conditions. Therefore, to make the unknowns and conditions 
equal in their numbers, a new point DPi is inserted into the curve 
Ci at a point of the curve length variable 5=^0.5 thereon, as shown 
in Fig. 69. In addition, as to the curve C2, a new point DP2 is 
inserted thereinto at a point of the curve length variable S=0.5 
thereon. 
[0462] 

In this situation, a curve connecting the points Pi and DPi 
is denoted by C 1, a curve connecting the points DPi and P2 is denoted 
by C 2f a curve connecting the points P2 and DP2 is denoted by C'3, 
and a curve connecting the points DP2 and P3 is denoted by C'4, 
respectively. The characters which appear in the following 
description involve with subscripts each corresponding to each 
curve name. For example, the coordinates, tangential rotation 
angles a and P, normal line, and curvature of a curve C are expressed 
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respectively by Pxc, Pyc, Pzc^ occ/ Pc/ ^nd i<c which are functions 
of the curve length variable S. Furthermore, as for the coordinates, 
tangential rotation angles a and P, normal line, and curvature at 
the starting and end points, those are expressed respectively as 
PXs, Pys/ Pzs/ OLs, Ps/ Hs and Ks at the starting point, whilst those 
are expressed respectively as Pxe, Pye/ PZe, ae, pe/ He and Ke the 
end point. 
[0463] 

In the following, the conditions realized at respective 
points are listed. 
[0464] 

[Numeral 122] 

Point Pi: tangential line, normal line and curvature; 4 expressions: 

cos[ac.i(0)-a3]-l 

cos[>^ci(0)-A] = l 
nci(0)-i^s =1 
C'l (0) = /^s 

Point DPi: position, tangential line, normal line and curvature; 
7 expressions: 
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Pxc.i(l) = Pxc2(0) 

Pyc'i(i) = Pyc2(0) 

Pzc.i(l) = Pzc2(0) 
cos[o^c-i (1) - (0)] = 1 
cos[y^C'i (1) - Pc'i (0)] = 1 
nc'i (l)-nc2(0) = l 
^Ci (l) = '^c'2(0) 

Point P2: position, tangential line, normal line and curvature; 7 
expressions : 

PXc.2(l) = PXc3(0) 

Pyc'2a) = Pyc'3(0) 

PZC2(1) = PZC3(0) 
COS[ac'2(l)-«^C3(0)] = 1 

cos[/?c'2a)-y^C3(0)] = l 
nc20)-nc3(0) = l 

'^C2(1) = '^C'3(0) 

Point DP2: position, tangential line, normal line and curvature; 
7 expressions: 
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PXc.3(l) = PXc4(0) 

Pyc'3(i) = Pyc4(0) 

PZc-3(l) = PZc4(0) 

cos[ac.3(l)-^^C4(0)] = 1 

COS[>^C3a)->^C4(0)] = l 

nc3(l)-nc'4(0) = l 
a:c'3(1) = ^C4(0) 



Point P3: position, tangential line, normal line and curvature; 7 
expressions : 

PXc.4(l) = PXe 

Pyc4a) = Pye 

PZc.4(l) = PZe 
C0S[ac'4(l)-^e] = 1 
COS[;^C'4(l)->^e] = l 

nc4(l)-ne =1 

^C4(l) = ^e 

[0465] 

Accordingly, the total number of conditional expressions to 
be established is 32. In contrast, each curve has the seven 
clothoid parameters consisting of ao, ai, a2, bo/ bi, h2, and h and 
the number of curves is 4, whereby the number of unknowns totals 
to 28. That is, the unknowns and the conditional expressions are 
not equal in number to each other, so that solutions cannot be 
obtained. In order to overcome this situation, the y and z 
coordinates of the newly inserted two points DPi and DP2 are treated 
as unknowns to increase the unknowns by 4. Since this increase 
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allows both the unknowns and the conditional expressions to be 32 

in number, the solutions can be obtained. 

[0466] 

(b~7) Decision 2 of initial values: 

Though the Newton-Rapson method is used to compute solutions 
satisfying the conditional expressions produced in section (b-6) , 
the initial values of the unknowns are required to be decided so 
that the computation converges at a higher rate. As a practical 
measure for that, the three-dimensional curve produced in section 
(b-5) is divided at the newly inserted points, with the result that 
four three-dimensional clothoid curves are produced as shown in 
Fig. 70, and the clothoid parameters are given to the curves. 
[0467] 

How to divide the curve Ci into a curve C i and a curve C 2 
will now be described as a curve division method. Using the 
parameters of the curve Ci, the clothoid parameters h' , a'o^ s'l/ 
a' 2/ b' 0/ b' 1 and b' 2 of the curve C i can be expressed by the following 
expressions, in which a reference Sd represents a curve length 
variable at the dividing point and is 0.5 in this example. 
[0468] 

[Numeral 123] 
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a'o =ao 
a; =aiSd 

a.2 = a2Sd 



b'o = bo 
b; = biSd 



b'a = b2Sd^ 
h' = hSd 



[0469] 



The consideration will then be given to the curve C'2 whose 
dividing point is DPi. Let us assume a curve C"i which is identical 
in size and shape to the curve Ci but is opposite in direction to 
the curve Ci. With the use of the parameters of the curve Ci, the 
clothoid parameters h", a"o, a"i, a"2, h"o, b"i and b"2 of the curve 
C"i can be expressed by the following expressions. 
[0470] 

[Numeral 124] 



The dividing point DPi on this curve is expressed as 




h 



P(l) 

+ &! + a2 + ^ 
-(ai +2a2) 
a2 

bo + b] + b2 
-(b, +2b2) 
b2 



[0471] 
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DPi=C"i (1-Sd) . When it is assumed that the curve C"i is divided at 
the point DPi, the resultant divided curves include a curve C"2 whose 
starting point is P2 is identical in size and shape to the curve 
C'2 and opposite in direction to the curve C'2- Hence the technique 
for producing the curve C'l enables the curve C"2 to be produced. 
In this calculation^ the curve C2 can also be obtained by producing 
a curve having the identical size and shape tut having the opposite 
direction too the curve C"2. 
[0472] 

This curve C2 has clothoid parameters h", a"o, a"i, a"2f b"o^ 
b"i, and b"2/ which are provided by the paraireters of the curve Co, 
which are as follows. 

[0473] 

[Numeral 125] 



a'o 


= ao +a,Sd +328^^ 


a? 


= (1-Sd){a, +2a2Sd} 


a2 


= a2(l-Sd)^ 


b'o 


= bo+biSd +b2Sd^ 


bj 


= (1-Sd){b, +2b2Sd} 


b2 


= b2(l-Sd)' 


h" 


= h(l-Sd) 



[0474] 

As described, at the point DPi giving 0 . 5 to the curve length 
variable S on the three-dimensional clothoid curve Ci, the curve 
Ci can be divided into the curves C'l and C': . Similarly to this, 
at the point DP2 giving 0 . 5 to the curve length variable S on the 
three-dimensional clothoid curve C2, the curve C2 can be divided 
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into the curves C'3 and C'4 . 
[0475] 

The parameters of the four curves divided on the foregoing 
are listed in Table 31. These parameters of the curves are used 
as initial parameters to the Newton-Rapson method in calculating 
solutions satisfying the conditional expressions established in 
section b-6. 
[0476] 
[Table 31] 

Parameters of curves produced by division 



curve 




0.0 (known) 


curve 




4 . 9134 


ai 


-2 . 7227 


ai 


-0.016629 




1 . 3530 


Bo 


1,3530 


ib 


n/2 (known) 


ib 


0.41633 


bi 


-1.9295 


bi 


-0.37938 


bi 


0.7750 


bz 


0.77507 


h 


6.7931 


h 


6.7931 


staring 
point 


{0.0, 0.0, 0.0} 


stariiig 
poin": 


{1.8431, 3.0860, 4.9597} 


carve 


<3o 


-0.033258 


curve 


ao 


7.1774 




1.8385 




0.016629 




-0.91093 




-0.91093 


bo 


0.81202 




1.0091 


bi 


0.80031 


b, 


-0.40601 


bz 


-0.60316 


b2 


-0.60316 




h 


4 . 6436 


h 


4.6436 


staring 
point 


{5.0, 5.0, 10.0} 


stariiig 
point 


{7.0029, 8.1298, 7.5337} 
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[0477] 

(b-8 ) Obtaining clothoid parameters satisfying conditions : 
Based on the initial values decided in section {b-7), the 
solutions satisfying the conditional expressions established in 
section (b-6) were obtained using the Newton-Rapson method. Table 
32 shows those calculated parameters of each curve. In addition^ 
Table 33 shows differences between given v£tlues and the produced 
values in respect of the tangential line, normal line, and curvature 
at the starting and end points of each produced curve. 
[0478] 
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[Table 32] 



Parameters of produced curves 



curve 


So 


0.0 (known) 


curve 


ao 


5.3846 




0.0000 


ai 


-3.4602 


32 


-0.89854 


32 


4.341 




Tc/2 (known) 


to 


0.47690 


b, 


-0.51836 


ih 


-3.2143 




-0.57552 


b2 


3.4613 


h 


5.1836 


h 


9.9808 


starting 

point 


{0.0, 0.0, 0.0} 


starting 
point 


{1.8431, 4.1726, 1.4653} 


curve 

C'3 


"30 


-0.017740 


curve 


ao 


6.8553 


ai 


3.4572 


3-L 


-1.1443 


32 


-2.8673 


32 


0.57219 




0.72385 


bo 


0.76315 




2.4551 


b, 


-1.1942 




-2.4158 


bz 


0.43108 


h 


5.60818 


h 


3.3206 


starting 
point 


{5.0, 5.0, 10.0} 


starting 
point 


{7.0029, 9.0734, 5.6186} 



[0479] 



[Table 33] 
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Differences between given values and produced values in respect 
of tangential line, normal line and curvature at starting and end 
points of produced curve 





coordinate 


vector 


TiTi nr^i 'n;=5l noTrrir^l 
vector 


curvature 




given 
value 


{0.0, 0.0, 0.0} 


{0.0, 1.0, 0.0} 


{1.0, 0.0, 0.0} 


0.10 


Pi 


value on 
produced 
cujTve- 


{0.0, 0.0, 0.0} 


{0.0, 1.0 0.0} 


{1.0, 0.0, 0.0} 


0.10 




difference 


{0.0, 0.0, 0.0} 


{0.0, 0.0, 0.0} 


{0-0, 0.0, 0.0} 


0 




given 
value 


{10.0, 10.0, 5.0} 


{1.0, 0.0, 0.0} 


{0.0, -1.0, 0.0} 


0.10 


P3 


value on 
produced 
curve 


{10.0, 10.0, 5.0} 


{1.0, 0.0, 0.0} 


{0.0, -1.0, 0.0} 


0.10 




difference 


{0.0, 0.0, 0.0} 


{0.0, 0.0, O.C} 


{0.0, 0.0, 0.0} 


0 



[0480] 

(b-9) Production of curves: 

A curve produced on the parameters obtained in section (b-8) 
is shown in Fig. 71. In this figure, the solid line depicts a 
three-dimensional clothoid curve, while the broken line, chain line, 
chain double-dashed line, and chain triple-dashed line depict 
respectively patterns of changes in the cuivature radius of each 
curve in which the change patterns are calculated on both the 
principal normal line which is set to the direction of each curve 
and the curvature radius which is set to the size of each curve 
(the radius curvature is subjected to the logarithm computation 
after addition of the logarithm natural) . Fig. 72 shows a graph 
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presenting the relationship between the distance s moved from the 
starting point of each curve and the curvature k depending on the 
respective types of the curves shown in Fig. 71. From Table 33, 
it is understood that the produced curves satisfy the given 
conditions . 
[0481] 

As described, how to produce the curves on the 
three-dimensional clothoid interpolation in such a manner that the 
tangential line, normal line and curvature at both ends are 
controlled has been exemplified. 
[0482] 

3. Numerical control technique using the three-dimensional 
clothoid interpolation : 

The curve on the foregoing three-dimensional clothoid 
interpolation can be used effectively for creating numerical 
control information necessary for control of motion of various 
objects being targeted including a tool of a machine tool. The 
characteristic of the control is easiness of speed control and 
possibility of smoothing changes in the speed. 
[0483] 

(1) Numerical control tecnnique using the 

three-dimensional clothoid interpolation: 

The numerical control technique that uses the 
three-dimensional clothoid interpolation curve is composed of 
procedures explained in Fig 73. 
[0484] 

(a) Design of motional trajectory of tool (Fig. 73, SI) : 
As stated in the preceding section, a three-dimensional 
clothoid interpolation curve that meets conditions is decided first. 
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When a tool of robots etc. is moved, it can be estimated that a 
representative point of the tool (tool point such as a tool center 
point) moves along a continuous trajectory curve (including a 
straight line) to be depicted two-dimensicnally or spatially as 
the time elapses. The positions of the tool point are expressed 
as coordinates (x, y, z) and the attitudes of the tool point are 
expressed by rotation angles, for example, with respect to the x-, 
y- and z-axes. Whatever the tool point may show any complicated 
motions, their trajectories are connected continuously, without 
discontinuations. Thus the first stage for the motion control is 
to design the shape of such a trajectory into a three-dimensional 
curve . 
[0485] 

(b) Application of motion curve (Fig. 73, S2) : 
In response to a command from numerical control, a 
distribution of moving speeds at points to be controlled on the 
curve is specified along the three-dimensional clothoid 
interpolation curve. That is, the second stage for the motion 
control is to decide speeds and accelerated speeds of the tool point 
moving along the design trajectory. A technical matter that the 
tool point moves along the trajectory based on what kind of temporal 
function is set by deciding the speeds and accelerated speeds of 
the tool point . The speeds, and accelerated speeds of the tool point 
can be decided based on either the time or a contour shape. In 
general, the decision based on the time is more frequent than the 
other. However, for example, for processing a curved surface, it 
is needed to meet the demand that a flat area of the surface needs 
a faster move of a tool and a curved area needs a slower move of 
the tool, whereby the speeds and accelerated speeds are decided 
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based on the contour shape, 
[0486] 

In the present embodiment, a good-characteristic curve used, 
for example, in a cum mechanism is employed for the interpolation. 
The positions and attitudes defined in the Cartesian space (real 
space) compose a group of continuous groups, and a motion curve 
is applied to each of the continuous groups to specify acceleration 
and deceleration. The Cartesical space is a three-dimensional 
coordinate system made by using three x-, y- and z-axes which are 
mutually perpendicular at the origin and is able to express the 
attitudes of the tool points as well as the positions thereof. 
[0487] 

(c) Time sharing (Fig. 73, S3) and computation of attitudes 
of tool in the Cartesian space (Fig. 73, S4) : 

In the present embodiment, every unit time during which 
numerical control information is computed, a moved distance and 
an attitude of the tool point is calculated in accordance with a 
moving speed specified to the object to be controlled. Thus, since 
the trajectory and motion have now been determined, the positions 
and attitudes of the tool point are given as functions of the time 
t. It is therefore possible to obtain displacements of the tool 
point at each time instant in that case that the time t is given 
as minute time intervals. The computation in this step (c) can be 
detailed as follows. At the point at which the tool point exists 
at present, not only values of the parameters such as a tangential 
line and a curvature but also positional information are known. 
Multiplying a specif led moving speed by a unxz, time provides a curve 
length that has moved during the unit time, and this curve length 
allows curve length parameters after the movement to be computed. 
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By using these curve length parameters after the movement, not only 
values of the parameters such as a tangential line and a curvature 
but also positional information can be computed at the next point 
to which the tool point has moved. 
[0488] 

The foregoing procedures make it possible that the position 
and attitude of the tool point at the time t in the Cartesian space 

(real space) . The variables in the thee-dimensional space are ''x, 
y, 2, y, \x, V, and 9,'' in which ''y, \i, v, and 9'' represent the attitude 
E in the form of equivalent rotation, ''y, and v" represent an 
axis of the equivalent rotation and "9" represents a rotation angle. 

[0489] 

Further, in response to a request from the numerical control, 
an offset point which is offset along the three-dimensional 
clothoid interpolation curve toward the normal line by a specified 
amount of dimension can be obtained. This is provided as a cutter 
path (a trajectory of the tool center) . The calculation for this 
cutter path is easier, because the normal line has already been 
determined. 
[0490] 

(d) Inverse Icinematics (Fig. 73, S5) : 

Next, the rotation angle of each axis, which is necessary 
for providing the tool point with its position and attitude, will 
now be obtained. This process is generally referred to as an 
inverse kinematics. If there is a robot with six axes, that is, 
there exist six joints, the position and attitude of the tool point 
is fixed depending on how many joints (such as a joint of a shoulder, 
joint of an arm, joint of an elbow, joint of a list, and others) 
turn. This is called a sequential kinematics. Unlike this, the 
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inverse kinematics is a process to obtain rotation angles 91 to 
66 in the axial space from the position and attitude of the tool 
point in the real space. An actuator installed to each axis is not 
always limited to a rotary motor, but may be a linearly-driven 
actuator such as a linear motor. Even in such a case, it is necessary 
to compute values about an electronic gear which converts a minimum 
limit real displacement into the number of input pulses to the linear 
motor. The inverse kinematics is inherent to each type of the 
mechanisms of robots etc, and the inverse kinematics is prepared 
for each of various robots. 
[0491] 

(e) Computation of displacement of notor for each axis in 
the axial coordinate system (Fig. 73, S6) : 

With respect to the respective time-snared tool points, the 
inverse kinematics are then computed, and then the computed values 
are subjected to computation of their integers which represent 
displacement pulses for the respective motors (including 
linearly-driven actuators) installed for the respective axes. In 
cases where the control is not carried on the pulses, a minimum 
resolution unit (resolution) assigned to each axial displacement 
is used as data processed into an integer corresponding to the number 
of pulses. 
[0492] 

The foregoing procedures (a) and (b; are preparatory, so 
those procedures are carried out only once, respectively. The 
procedures (c) to (e) are carried out at intervals of a specified 
unit time and continue until a period of time to be targeted or 
conditions to be targeted are met. 
[0493] 



194 



It is possible that the foregoing all procedures for the 
computation are carried out by the same numerical control device. 
Alternatively, with the procedures (a) and (b) previously computed 
and decided by a further computer, • the resultant curve parameters 
from those procedures are sent into the numerical control device, 
where the procedures (c) to (e) are then subjected to computation. 
[0494] 

(2) NC device and CNC device: 

Now, description will be given to a case in which an 
independent numerical control device (NC device) is used and a 
further case in which a CNC device is used that integrally combines 
a computer serving as programs and an NC device. 
[0495] 

(a) In cases where independent NC device is used: 
A conventionally used normal NC machine is separated, in 
terms of hardware, into two devices consisting of a programmer that 
performs programming to create NC data and an NC device that uses 
the NC data to drive a machine apparatus. In contrast, in the case 
of a recently used CNC machine, a computer in charge of programming 
is incorporated within an NC device in an integrated manner. 
[0496] 

First, as to the former one, that is, the independent NC 
device is used, the numerical control technique on the 
three-dimensional clothoid is proposed. In this case, an 
assumption is made such that clothoid parameters are used for 
transmitting and receiving clothoid data. And a clothoid format 
is defined in the G code, which is for example as follows. 

G * * * 

AO, Al, A2, BO, Bl, B2, H 
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[0497] 

The notation ''G * * indicates the G-code number. The 
notations ^'AO to H'' indicate seven parameters of a 
three-dimensional clothoid segment- Before performing this code, 
a tool has come to a position Pq. In the NC device, those parameters 
are used to compute an instantaneous tool position or a positional 
difference of the tool position. This procedure is called a 
''sequential solution." The reason why the sequential solution is 
obtained in the NC device is to prevent data from being produced 
largely. Therefore, the NC device requires a kind of computation. 
Expressing the clothoid by the G code makes it possible that the 
clothoid curve is combined into the existing NC device. 
[0498] 

(c) CNC technique: 

The CNC device, in which a computer functioning as a 
programmer is integrally combined with an NC device, will now be 
described. In this configuration, which hardware part of the CNC 
device computes values concerning with the clothoids does not 
become an issue. In addition, concern about a data amount and a 
transfer speed are on the dismissal. 
[0499] 

In general, the programmer includes a step to decide clothoid 
parameters suitable to respective conditions. This is called an 
''inverse solution.'' For example, this inverse solution includes 
a program which computes a smooth curve passing a row of some 
discrete points in a strict manner (that is, interpolation for a 
row of free points) . Moreover, it is frequent that the inverse 
solution a program for deciding trajectories of a tool which is 
necessary for processing (that is, CAM) . 
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[0500] 

(3) Characteristics of numerical control technique using 
the three-dimensional clothoid interpolation: 

The numerical control technique using the three-dimensional 
clothoid curve has the following advantages. 
[0501] 

(a) As described above, the curve is expressed by 
independent parameters which represent the curve length moved from 
a reference point, so that numerical control information 
corresponding to a specif led moving speed can be produced. In other 
curves, such as spline curves, which are expressed by independent 
parameters having no relation to the curve length, it is difficult 
to calculate the values of independent parameters corresponding 
to a point to which a tool point is to move, even if such an after-move 
point may be found by calculation. Hence in this case, numerical 
control information corresponding to a specified moving speed is 
difficult to produce. 
[0502] 

To be specific, as shown in Fig. 74, it is assumed that a 
tool is moved at a liner velocity from a point Rq on a trajectory 
expressed by a spline function R(t) . When a target point for the 
tool is calculated at regular intervals, an amount AS of move of 
the tool achieved after an elapse of the unit time is found. However, 
because an independent variable t is not related to the time or 
curve length, an amount At of changes of the independent variable 
cannot be computed at once. That is, for obtaining the change 
amount At, it is required to resolve an expression of Ro+AS=R (to+At ) . 
Without having the amount At, the target point cannot be calculated, 
resulting in that resolving the above expression should be repeated 
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at regular intervals. 

[0503] 

(b) In the case of the three-dimensional clothoid curve, 
it is expected that how the curvature changes to the curve length 
is approximately constant, and it is expected that corresponding 
numerical control information is provided as control information 
which requires less dynamic overload in controlling the motion. 
In the general spline interpolation etc., it is difficult to 
estimate and control changes in the curvature. 

[0504] 

(c) The three-dimensional clothoid curve includes, as 
special cases thereof, straight lines, circular arcs, and spiral 
curves, and numerical control information in relation to a variety 
of curves can be expressed strictly, with no combination with 
individual curve expressions. 

[0505] 

(d) The three-dimensional clothoid curve is based on a 
natural equation independent of how the coordinate axes are set. 
In the conventional NC device in which curves are represented with 
the X-, y- and z-axes, processing of a workpiece depends on how 
to install the workpiece; for example, when an obliquely installed 
workpiece is required to be processed, an obliquely set surface 
of the workpiece may be easy or difficult co process, depending 
on how the workpiece is installed. In the three-dimensional 
clothoid curve, the curve is given as line lengths, with the result 
that even for processing an oblique surface of a workpiece, 
producing trajectories along the oblique surface allows the 
processing to be done in the same way as that for the horizontal 
surface. 
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[0506] 

In the present invention, in cases where a computer is 
configured to perform a program expressing a trajectory of a machine 
tool or a contour shape of a workpiece by using a three-dimensional 
curve (referred to as a three-dimensional clothoid curve) in which 
each of a pitch angle and a yaw angle in a tangential direction 
is given by a quadratic expression of a curve length or a curve 
length variable, the program can be stored in an auxiliary storage, 
such as a hard disk unit, of the computer, in which a main memory 
of the computer can receive loaded program data in order to perform 
the program. Further, such a program can be stored in portable 
recording mediums such as CD-ROMs for trading or stored in a storage 
of a computer communicably connected to a network in order to 
transfer program data to other computers via the network. 
Furthermore, results computed by such a program (curve parameters 
of a three-dimensional clothoid curve, displacement pulses for 
motors installed for respective axes, and others) can be stored 
in portable recording mediums such as CD-ROMs for trading. 
[0507] 

Industrial applicability 

Thanks to the three-dimensional curve according to the 
present invention, the versatile technique for producing spatial 
curves required for designing and producing industrial products 
can be provided. When an object moves at accelerated or decelerated 
speeds along spatial curves, design which makes changes in binding 
force smoother can be done. This characteristic is widely 
applicable to the method for designing trajectories of motion of 
a mechanical element with mass. As an application of the design 
according to the present invention, how to design the regression 



199 



path of the ball screw has been descried. However, the application 
is not limited to such an application but can be widely applicable 
to design of other objects, which include a rail of a roller coaster 
which runs at fast speeds along a rail winding up and down and back 
and forth, linear guides, and other objects . Other than listed here, 
thanks to the characteristic that changes in the curvature can be 
designed properly to the curve length, the design technique 
according to the present invention can be applied to other various 
industrial fields such as a field involving design of aesthetic 
design curves. 



